TurtleBot / Mbed 2 deprecated testLibrary

malin

Dependencies:   Servo mbed mbed-rtos

main.cpp

Committer:
Khanchana
Date:
2018-01-30
Revision:
0:596de9a5c573
Child:
1:da79761252bc

File content as of revision 0:596de9a5c573:

#include "mbed.h"
#include "Servo.h"
 
Servo Servo1(D6);
Servo Servo2(D7);
 
int main() {
    Servo1.Enable(1000,20000);
    Servo2.Enable(1000,20000);
    Servo2.Disable();
    for (int pos = 1000; pos < 1500; pos += 25) {
            Servo1.SetPosition(pos);
            wait(0.05);
        }
    for (int pos = 1500; pos > 1000; pos -= 25) {
            Servo1.SetPosition(pos); 
            wait(0.05);
        }
    Servo2.Enable(1000,20000);
    Servo1.Disable();
    for (int pos = 1000; pos < 1500; pos += 25) {
            Servo2.SetPosition(pos);
            wait(0.05);
        }
    for (int pos = 1500; pos > 1000; pos -= 25) {
            Servo2.SetPosition(pos); 
            wait(0.05);
        }
}