Diff: main.cpp

Revision:

6:6659a8ada914

Parent:

5:f49c7b6e8bcc

Child:

7:ed076babd381

--- a/main.cpp	Tue Feb 28 10:36:50 2017 +0000
+++ b/main.cpp	Fri Mar 03 08:00:11 2017 +0000
@@ -4,13 +4,53 @@
 DigitalOut Motor2 (A0);
 DigitalOut Motor3 (D12);
 DigitalOut Motor4 (D11);
-AnalogIn Sensor (A1);
+AnalogIn Sensor1 (A1);
+AnalogIn Sensor2 (A2);
+AnalogIn Sensor3 (A3);
+AnalogIn Sensor4 (A4);
+
 
 
 
 int main() {
     while(1) {
-        if ( Sensor >= 100) {
+        if ( Sensor1 >= 100) {
+          Motor1 = 0 ;
+          Motor2 = 1 ;
+          Motor3 = 0 ;
+          Motor4 = 1 ;
+          wait_ms (500);
+          Motor1 = 1 ;
+          Motor2 = 0 ;
+          Motor3 = 0 ;
+          Motor4 = 1 ;
+          wait_ms (1000);
+          }
+          or (Sensor2 >= 100) {
+          Motor1 = 0 ;
+          Motor2 = 1 ;
+          Motor3 = 0 ;
+          Motor4 = 1 ;
+          wait_ms (500);
+          Motor1 = 1 ;
+          Motor2 = 0 ;
+          Motor3 = 0 ;
+          Motor4 = 1 ;
+          wait_ms (1000);
+          }
+          or (Sensor3 >= 100) {
+          Motor1 = 0 ;
+          Motor2 = 1 ;
+          Motor3 = 0 ;
+          Motor4 = 1 ;
+          wait_ms (500);
+          Motor1 = 1 ;
+          Motor2 = 0 ;
+          Motor3 = 0 ;
+          Motor4 = 1 ;
+          wait_ms (1000);
+          }
+          or (Sensor4 >= 100) {
           Motor1 = 0 ;
           Motor2 = 1 ;
           Motor3 = 0 ;