Diff: main.cpp

Revision:

0:7da591ec2935

Child:

1:2e6087aa66e3

--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/main.cpp	Sat Mar 09 12:27:52 2019 +0000
@@ -0,0 +1,34 @@
+#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;
+
+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;  
+}