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

fix servo glitches on low voltage

Browse Source
This commit is contained in:
Stepan Usatiuk
2019-08-06 11:49:56 +03:00
parent e3e5b2cc5d
commit 6e451b3b9a
1 changed files with 10 additions and 3 deletions
Download Patch File Download Diff File Expand all files Collapse all files

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

@@ -8,16 +8,22 @@ Pen::Pen(int pin, int posEngaged, int posDisengaged)
void Pen::engage() {
if (!engaged) {
servo.write(posEngaged);
servo.attach(pin);
delay(5);
servo.write(posEngaged);
delay(200);
servo.detach();
}
engaged = true;
}
void Pen::disengage() {
if (engaged) {
servo.write(posDisengaged);
servo.attach(pin);
delay(5);
servo.write(posDisengaged);
delay(200);
servo.detach();
}
engaged = false;
}
@@ -25,8 +31,9 @@ void Pen::disengage() {
void Pen::init() {
servo.attach(pin);
servo.write(posDisengaged);
delay(5);
delay(200);
engaged = false;
servo.detach();
}
bool Pen::getEngaged() { return engaged; }