|
|
@ -144,6 +144,7 @@ void handleSerialCommands() {
|
|
|
|
if (sscanf(command.c_str(), "s%d %d", &servoNum, &dutyCycle) == 2) {
|
|
|
|
if (sscanf(command.c_str(), "s%d %d", &servoNum, &dutyCycle) == 2) {
|
|
|
|
if (servoNum >= 0 && servoNum < numServos && dutyCycle >= 0 && dutyCycle <= 255) {
|
|
|
|
if (servoNum >= 0 && servoNum < numServos && dutyCycle >= 0 && dutyCycle <= 255) {
|
|
|
|
analogWrite(servoPins[servoNum], dutyCycle);
|
|
|
|
analogWrite(servoPins[servoNum], dutyCycle);
|
|
|
|
|
|
|
|
(servoNum == 0 ? servo1 : servo2)->setPWM(servoPins[servoNum], 60, dutyCycle);
|
|
|
|
}
|
|
|
|
}
|
|
|
|
}
|
|
|
|
}
|
|
|
|
}
|
|
|
|
}
|
|
|
|