stepus53/EggbotWireless
1
0
Fork 0
mirror of https://github.com/usatiuk/EggbotWireless.git synced 2025-10-26 08:47:49 +01:00
Code Issues Packages Projects Releases Wiki Activity

[AVR] smooth servo

Browse Source
This commit is contained in:
Stepan Usatiuk
2020-03-19 14:24:18 +03:00
parent cd598dba7f
commit b6349c2623
1 changed files with 8 additions and 6 deletions
Download Patch File Download Diff File Expand all files Collapse all files

14
Firmware/MotorControl/src/Pen.cpp
View File

@@ -8,18 +8,20 @@ Pen::Pen(int pin, int posEngaged, int posDisengaged)
void Pen::engage() {
if (!engaged) {
servo.attach(pin);
servo.write(posEngaged);
delay(200);
for(int i = posDisengaged; i > posEngaged; i--) {
servo.write(i);
delay(5);
}
}
engaged = true;
}
void Pen::disengage() {
if (engaged) {
servo.attach(pin);
servo.write(posDisengaged);
delay(200);
for (int i = posEngaged; i > posDisengaged; i++) {
servo.write(i);
delay(5);
}
}
engaged = false;
}