Fa2018-es200-1121-project2-herndon-toss / Mbed 2 deprecated Project2

Start of project 2

Dependencies:   Motor Servo mbed mbed-rtos

Diff: main.cpp

Revision:
4:a3e95c9d56d5
Parent:
2:60a8105d0d20
Parent:
3:50cee0fef078
Child:
5:27689dbb0c6e
--- a/main.cpp	Tue Oct 09 13:40:51 2018 +0000
+++ b/main.cpp	Wed Oct 10 12:33:06 2018 +0000
@@ -11,6 +11,7 @@
 DigitalIn swtch4(p21);
 AnalogIn turn(p22);
 Motor m(p26, p30, p29);
+DigitalIn sw1 (p16) ;
 
 Servo back(p21);
 Servo angle(p22);
@@ -45,5 +46,22 @@
         wait (.05);
           
           } //end of while loop
-      
+    
+    sw1.read();
+    if (sw1==1) {
+        while(1) {
+            m.speed(1);
+            wait (.15);
+            m.speed(0);
+            wait (1);
+            break;
+        }
+        while(1) {
+            m.speed(-.25);
+            wait(.6);
+            m.speed(0);
+            wait(1);
+            break;
+        }
+        }
     } //end of int main