Diff: linetrace.cpp

Revision:

0:47cd78404bd9

--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/linetrace.cpp	Thu Oct 16 14:29:37 2014 +0000
@@ -0,0 +1,35 @@
+#include "mbed.h"
+#include "MotorDriver_SU.h"
+
+DigitalIn sensor1();
+DigitalIn sensor2();
+DigitalOut led1();
+DigitalOut led2();
+MotorDriver_SU motor(MOTOR_DOUBLE);
+MotorDriver_SU lift(MOTOR_SINGLE);
+
+int main(){
+    while(1){
+        if(sensor1 == 0 && sensor2 == 0){
+            motor.Drive(0,CW,3000);
+            motor.Drive(1,CW,3000);
+            lift.Drive(0,CW,3000);
+            led1 = 1;
+            } 
+        else if(sensor1 == 0 && sensor2 == 1){
+                motor.Drive(0,CW,3000);
+                motor.Drive(1,CCW,1500);
+                led1 = 0;
+                } 
+        else if(snsor1 == 1 && sensor2 == 0){
+                    motor.Drive(0,CCW,1500);
+                    motor.Drive(1,CW,3000);
+                    led2 = 1;
+                    }
+        else if(sensor == 1 && sensor ==1){
+                    motor.Drive(0,CCW,3000);
+                    motor.Drive(1,CCW,3000);
+                    led2 = 0;
+                    }
+              }
+            }
\ No newline at end of file