A program using forked servo.h that allows controlling the speed of multiple individual servos. Each servo runs at a different speed if required. ANY output port can be used. (PWM not required)
Dependencies: VarSpeedServo mbed
Diff: main.cpp
- Revision:
- 2:95cabad9292b
- Parent:
- 0:0f740c5bbb7a
diff -r 1a696cb039ef -r 95cabad9292b main.cpp --- a/main.cpp Mon Oct 12 15:01:58 2015 +0000 +++ b/main.cpp Wed Oct 14 02:11:24 2015 +0000 @@ -37,16 +37,17 @@ Servo Servo2(D10); Servo1.Enable(1500,50,10); // Start position ; in us (1500 = center), servo refresh rate in Hz (analog servos = 50 Hz), servo movement speed range from 1-50, 1 slowest, about 20 seconds/180 degrees Servo2.Enable(1500,50,10); + + wait(5.0); while(1) { - Servo1.SetPosition(2300); - Servo2.SetPosition(2300); - wait(2.5); - - Servo1.SetPosition(700); Servo2.SetPosition(700); wait(2.5); + + Servo1.SetPosition(2300); + Servo2.SetPosition(2300); + wait(2.5); } }