Diff: main.cpp

Revision:

0:130d9f9e96f3

--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/main.cpp	Wed Nov 05 16:59:58 2014 +0000
@@ -0,0 +1,48 @@
+#include "mbed.h"
+#include "Motor.h"
+ 
+DigitalIn sen1(p20);
+DigitalIn sen2(p19);
+
+DigitalOut led1(LED1);
+DigitalOut led2(LED2);
+DigitalOut led3(LED3);
+DigitalOut led4(LED4);
+
+Motor m1(p23, p5, p6); // pwm, fwd, rev
+Motor m2(p24, p7, p8); // pwm, fwd, rev
+ 
+int main() {
+    while(1) {
+        if(sen1 and sen2) {
+            led1 = !led1;
+            m1.speed(0.5);
+            led4 = !led4;
+            m2.speed(0.5);
+        }
+           
+        if(sen2 ==0 and sen1)
+        {
+            m2.speed(0.5);
+            led1=!led1; 
+            m1.speed(0.5);
+        }
+    
+        if(sen2 and sen1 == 0)
+        {
+            m2.speed(0);
+            m1.speed(0.5);
+            led4=!led4;
+        
+        }
+        
+           if(sen2==0 and sen1==0)
+        {
+            m2.speed(0);
+            m1.speed(0);
+            led3=!led3;
+            led2=!led2;
+            wait(0.5);
+        }
+    }
+}
\ No newline at end of file