File content as of revision 1:da79761252bc:

#include "mbed.h"
#include "Servo.h"
#include "rtos.h"
 
Servo Servo1(D7);
Servo Servo2(D6);
Servo Servo3(D9);
Servo Servo4(D8);
Thread thread;

void myservoright_thread() {       
    while(1){
    Servo3.Enable(1000,20000);
    Servo4.Disable();
    for (int pos = 1400; pos <= 1700; pos += 5) {
            Servo3.SetPosition(pos);
            wait(0.01);
        }
    Servo4.Enable(1000,20000);
    Servo3.Disable();
    for (int pos = 1000; pos <= 1700; pos += 5) {
            Servo4.SetPosition(pos);
            wait(0.01);
        }
    Servo3.Enable(1000,20000);
    Servo4.Disable();
    for (int pos = 1700; pos >= 1400; pos -= 5) {
            Servo3.SetPosition(pos); 
            wait(0.01);
        }
    Servo4.Enable(1000,20000);
    Servo3.Disable();
    for (int pos = 1700; pos >= 1000; pos -= 5) {
            Servo4.SetPosition(pos); 
            wait(0.01);
        }
    }
}
 
int main() {
    while(1){
    Servo1.Enable(1000,20000);
    Servo2.Disable();
    thread.start(myservoright_thread);
    for (int pos = 1400; pos <= 1700; pos += 5) {
            Servo1.SetPosition(pos);
            wait(0.01);
        }
    Servo2.Enable(1000,20000);
    Servo1.Disable();
    for (int pos = 1000; pos <= 1700; pos += 5) {
            Servo2.SetPosition(pos);
            wait(0.01);
        }
    Servo1.Enable(1000,20000);
    Servo2.Disable();
    for (int pos = 1700; pos >= 1400; pos -= 5) {
            Servo1.SetPosition(pos); 
            wait(0.01);
        }
    Servo2.Enable(1000,20000);
    Servo1.Disable();
    for (int pos = 1700; pos >= 1000; pos -= 5) {
            Servo2.SetPosition(pos); 
            wait(0.01);
        }
    }
}