Diff: main.cpp

Revision:

1:829cbbaeaf32

Parent:

0:afc37ce56e1f

Child:

2:7e5d670ed9aa

--- a/main.cpp	Wed Jul 31 19:13:17 2019 +0000
+++ b/main.cpp	Wed Jul 31 19:33:40 2019 +0000
@@ -1,35 +1,62 @@
 #include "mbed.h"
 #include "Servo.h"
-DigitalOut myled(LED2), myled2(LED1), led3(LED3);
-Servo servo1(p24), servo2(p23), servo3(p22), servo4(p21);
-int numServos = 4;
+
+#define NUM_SERVOS 4
+Servo servo[NUM_SERVOS]={p24,p23,p22,p21};
 float range = 0.0005;
 float degrees = 45.0;
 
-void together(Servo * servoPtr)
+
+
+void together();
+
+int main() {     
+    printf("Hello bats!\n");
+    
+    printf("entering loop\n"); 
+    while(1) {        
+        printf("entering together() call\n");
+        together();
+        //wait(10);
+        //apart1(servoPtr);
+    }
+    
+}
+
+
+
+
+
+
+
+
+
+void together()
 {
-    int i,j;
+    float i; 
+    int j;
+    
     for(i = 0.0; i<1.00; i+=0.01)
     {
-        for(j = 0; j<numServos; j++)
+        for(j = 0; j<NUM_SERVOS; j++)
         {
-            servoPtr[j] = i;
+            servo[j] = i;
         }
         wait(0.01);
     }
     wait(5);
     for(i = 1.0; i>0.00; i-=0.01)
     {
-        for(j = 0; j<numServos; j++)
+        for(j = 0; j<NUM_SERVOS; j++)
         {
-            servoPtr[j] = i;
+            servo[j] = i;
         }
         wait(0.01);
     }
     printf("finished one of together\n");
 }
     
-void apart1 (Servo * servoPtr)
+/*void apart1 (Servo * servoPtr)
 {
     int i,j;
     for(i = 0.0; i<1.00; i+=0.01)
@@ -57,79 +84,4 @@
     }
     printf("finished one of together\n");
 }
-
-int main() {
-    myled = 1;
-    wait(2);
-    myled = 0;
-    myled2 = 1;
-    wait(2);
-    myled2 = 0;
-    led3 = 1;
-    wait(2);
-    led3 = 0;
-    
-    Servo servoArr [] = {servo1, servo2, servo3, servo4};
-    Servo *servoPtr;
-    int x;
-    //for(x = 0; x<numServos; x++)
-//    {
-//        myled = 1;
-//        servoArr[x].calibrate(range, degrees);
-//    }
-    myled = 0;
-    myled2 = 0;
-    servoPtr = servoArr;
-    //while(1) {
-    for(x = 0; x<10; x++){
-        myled = 0;
-        myled2 = 1;
-        wait(2);
-        
-        int i,j;
-        for(i = 0.0; i<1.00; i+=0.01)
-        {
-            for(j = 0; j<numServos; j++)
-            {
-                servoPtr[j] = i;
-            }
-            wait(0.01);
-        }
-        myled = 1;
-        myled2 = 0;
-        wait(5);
-        for(i = 1.0; i>0.00; i-=0.01)
-        {
-            for(j = 0; j<numServos; j++)
-            {
-                servoPtr[j] = i;
-            }
-            wait(0.01);
-        }   
-        wait(5);
-        
-        
-        
-        myled = 0;
-        myled2 = 1;
-        
-        wait(2);
-        for(i = 0.0; i<1.0; i+=0.01)
-        {
-            servoPtr[1] = i;
-            wait(0.01);
-        } 
-        wait(2);
-        for(i = 1.0; i>0.0; i-=0.01)
-        {
-            servoPtr[1] = i;
-            wait(0.01);
-        }
-        wait(4);
-        
-        //together(servoPtr);
-        //wait(10);
-        //apart1(servoPtr);
-    }
-    
-}
+*/
\ No newline at end of file