Diff: main.cpp

Revision:

3:9640475cdfbe

Parent:

2:49ad86fca628

Child:

4:707923a648dc

--- a/main.cpp	Wed Dec 06 16:51:21 2017 +0000
+++ b/main.cpp	Thu Dec 07 15:01:47 2017 +0000
@@ -3,19 +3,60 @@
 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 = 1000; pos < 2000; pos += 25) 
+      for (int pos = 500; pos < 2000; pos += 25) 
       {
           Servo1.SetPosition(pos);  
           wait_ms(20);
       }
-      for (int pos = 2000; pos > 1000; pos -= 25) {
+      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;
   }
\ No newline at end of file