Diff: main.cpp

Revision:

0:7f6500381cc2

--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/main.cpp	Wed Dec 27 08:42:10 2017 +0000
@@ -0,0 +1,40 @@
+#include "mbed.h"
+Serial pc(SERIAL_TX,SERIAL_RX);
+Serial blue (D8,D2);
+PwmOut servo0(D3);
+
+DigitalOut myled(LED1);
+
+int main() {
+    pc.printf("123");
+    servo0.period_ms(5);
+    blue.baud(9600);
+    while(1){
+    
+    if(blue.readable()){        
+    char key =blue.getc();
+        if(key == 'r'){
+            pc.printf("RIGHT");
+            servo0.period_ms(5);
+            servo0.write(0.15);
+            wait(1.5);
+            servo0.write(0.28);
+            }
+        else if(key=='g'){
+            pc.printf("GO");
+            servo0.period_ms(5);
+            servo0.write(0.28);
+            wait(1.5);
+        }
+        else if(key=='l'){
+            pc.printf("LEFT");
+            servo0.period_ms(5);
+            servo0.write(0.45);
+            wait(1.5);
+            servo0.write(0.25);
+            
+            wait(1);
+        }
+    }
+}
+}