Diff: main.cpp

Revision:

1:2e6087aa66e3

Parent:

0:7da591ec2935

--- a/main.cpp	Sat Mar 09 12:27:52 2019 +0000
+++ b/main.cpp	Sat Nov 30 16:35:52 2019 +0000
@@ -1,34 +1,26 @@
 #include "mbed.h"
 
-//DigitalOut myled(LED1);
-//DigitalIn  sw(p11);
-PwmOut     servo1(PB_4);
-PwmOut     servo2(PB_5);
-DigitalOut servo1_signal(PA_0);
-DigitalOut servo2_signal(PA_1);
-Serial pc(PA_2, PA_3);
-bool sw_tf = true;
+DigitalOut myled(LED1);
+PwmOut     servo_DOWN(p21);
+PwmOut     servo_UP(p25);
+DigitalIn  signal(p30);
+
+#define ROCK_DOWN 0.0015
+#define OPEN_DOWN 0.0024
+
+#define ROCK_UP 0.0015
+#define OPEN_UP 0.0006
 
 int main(){
-    pc.baud(38400);
-    wait(2.0);
-    pc.printf("Hello world\r\n");
-    servo1_signal = 0;
-    servo2_signal = 0;
     while(1){
-            wait(2);
-            servo2.pulsewidth(0.0015);
-            servo1.pulsewidth(0.0024);
-            pc.printf("1\r\n");
-            wait(2);
-            servo2.pulsewidth(0.0024);
-            servo1.pulsewidth(0.0006);
-            pc.printf("2\r\n");
-            wait(2);
-            servo2.pulsewidth(0.0006);
-            servo1.pulsewidth(0.0015);
-            pc.printf("3\r\n");
-            
-    }              
-    return 0;  
-}
+        servo_DOWN.pulsewidth(ROCK_DOWN);
+        servo_UP.pulsewidth(ROCK_UP);
+        while(signal == 1){
+            servo_DOWN.pulsewidth(OPEN_DOWN);
+            servo_UP.pulsewidth(OPEN_UP);
+            myled = 1;
+        }
+        myled = 0;
+    }
+    return 0;
+}
\ No newline at end of file