Just set up the pin. Don't move to a random position. Simplify servo::move() * servo::move() does not need the pin parameter - The pin is set during servo_init() with attach(). * servo::move() does not need a return value. SERVO_LEVELING is the wrong condition to deactivate the servos. Remove some temporary (Servo *) variables. SanityCheck for the servo indexes. |
||
|---|---|---|
| .. | ||
| biv2.5 | ||
| generic | ||
| kossel_mini | ||
| kossel_pro | ||