dit is em

Dependencies:   mbed

main.cpp

Committer:
jasperH
Date:
2017-03-03
Revision:
9:daba5ca15c59
Parent:
1:330d2f94f2b6

File content as of revision 9:daba5ca15c59:

#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 >= 1) {
          Motor1 = 0 ;
          Motor2 = 1 ;
          Motor3 = 0 ;
          Motor4 = 1 ;
          wait_ms (2500);
          Motor1 = 1 ;
          Motor2 = 0 ;
          Motor3 = 0 ;
          Motor4 = 1 ;
          wait_ms (5000);
          }
          or (Sensor2 >= 1) {
          Motor1 = 0 ;
          Motor2 = 1 ;
          Motor3 = 0 ;
          Motor4 = 1 ;
          wait_ms (2500);
          Motor1 = 1 ;
          Motor2 = 0 ;
          Motor3 = 0 ;
          Motor4 = 1 ;
          wait_ms (5000);
          }
          or (Sensor3 >= 1) {
          Motor1 = 0 ;
          Motor2 = 1 ;
          Motor3 = 0 ;
          Motor4 = 1 ;
          wait_ms (2500);
          Motor1 = 1 ;
          Motor2 = 0 ;
          Motor3 = 0 ;
          Motor4 = 1 ;
          wait_ms (5000);
          }
          or (Sensor4 >= 1) {
          Motor1 = 0 ;
          Motor2 = 1 ;
          Motor3 = 0 ;
          Motor4 = 1 ;
          wait_ms (2500);
          Motor1 = 1 ;
          Motor2 = 0 ;
          Motor3 = 0 ;
          Motor4 = 1 ;
          wait_ms (5000);
          }
        else {
          Motor1 = 1 ;
          Motor2 = 0 ;
          Motor3 = 1 ;
          Motor4 = 0 ;
          }
          
        
    }
}