File content as of revision 3:9640475cdfbe:

#include "mbed.h"
#include "Servo.h"
int main(int argc, char* argv[])
{  
 Servo Servo1(PD_13);
 Servo Servo2(PD_12);
 Servo Servo3(PD_14);
 Servo Servo4(PD_15);
 
  Servo1.Enable(1500,20000);
  Servo2.Enable(1500,20000);
  Servo3.Enable(1500,20000);
 // Servo4.Enable(1500,20000);
 
  while(1) {
      for (int pos = 500; pos < 2000; pos += 25) 
      {
          Servo1.SetPosition(pos);  
          wait_ms(20);
      }
      for (int pos = 2000; pos > 500; pos -= 25) {
          Servo1.SetPosition(pos); 
          wait_ms(20); 
      }
      
      //================================
      for (int pos = 500; pos < 2000; pos += 25) 
      {
          Servo2.SetPosition(pos);  
          wait_ms(20);
      }
      for (int pos = 2000; pos > 500; pos -= 25) {
          Servo2.SetPosition(pos); 
          wait_ms(20); 
      }
      
      //============================
       for (int pos = 500; pos < 2000; pos += 25) 
      {
          Servo3.SetPosition(pos);  
          wait_ms(20);
      }
      for (int pos = 2000; pos > 500; pos -= 25) {
          Servo3.SetPosition(pos); 
          wait_ms(20); 
      }
      
      //============================
      for (int pos = 0; pos < 2600; pos += 25) 
      {
          Servo4.SetPosition(pos);  
          wait_ms(20);
      }
      for (int pos = 2600; pos > 0; pos -= 25) {
         Servo4.SetPosition(pos); 
          wait_ms(20); 
      }
      
      //===========================
  }
  return 0;
  }