project enzo / Mbed 2 deprecated robot Featured

dit is em

Dependencies:   mbed

main.cpp

Committer:
bjorntukkertje
Date:
2017-03-03
Revision:
6:6659a8ada914
Parent:
5:f49c7b6e8bcc
Child:
7:ed076babd381

File content as of revision 6:6659a8ada914:

#include "mbed.h"

DigitalOut Motor1 (D13);
DigitalOut Motor2 (A0);
DigitalOut Motor3 (D12);
DigitalOut Motor4 (D11);
AnalogIn Sensor1 (A1);
AnalogIn Sensor2 (A2);
AnalogIn Sensor3 (A3);
AnalogIn Sensor4 (A4);




int main() {
    while(1) {
        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 ;
          Motor4 = 1 ;
          wait_ms (500);
          Motor1 = 1 ;
          Motor2 = 0 ;
          Motor3 = 0 ;
          Motor4 = 1 ;
          wait_ms (1000);
          }
        else {
          Motor1 = 1 ;
          Motor2 = 0 ;
          Motor3 = 1 ;
          Motor4 = 0 ;
          }
          
        
    }
}