Fährt wenn der Sensor Lichtsignale rückempfängt, die er gesendet hat

Dependencies:   mbed

Uebung1.cpp

Committer:
marcusrus
Date:
2016-06-08
Revision:
0:b4f9731c4fad

File content as of revision 0:b4f9731c4fad:

#include "mbed.h"

DigitalOut Von (P2_13);      // 12 V ON 
DigitalOut LineON (P2_5);    // Line Sensor aktivieren
DigitalIn ISO1 (P1_9);       // ISO1
DigitalIn ISO2 (P0_16);
DigitalIn ISO3 (P0_23);
DigitalIn ISO4 (P0_15);
DigitalIn ISO5 (P1_3);       // OSI5
 
DigitalOut LedD1 (P1_10);      
DigitalOut LedD2 (P1_11);
DigitalOut LedD4 (P1_12);
DigitalOut LedD5 (P1_13);
DigitalOut LedD6 (P1_14);      
DigitalOut LedD7 (P1_15);
DigitalOut LedD8 (P1_16);
DigitalOut LedD9 (P1_17);
DigitalOut LedD10 (P1_18);     
DigitalOut LedD11 (P2_16);
DigitalOut LedD12 (P1_20);
DigitalOut LedD13 (P1_21);

DigitalOut MotorL_EN(P1_19);      // Enable          
DigitalOut MotorL_FORWARD(P2_14); // Forwärts  
DigitalOut MotorL_REVERSE(P2_15); // Rückwärts  

DigitalOut MotorR_EN(P2_19);      //Die Leitung führt zum Pin PO_21 am Prozessor
DigitalOut MotorR_FORWARD(P2_21); //Die Leitung führt zum Pin P1_3 am Prozessor
DigitalOut MotorR_REVERSE(P2_20);


int main() 
{
   
   do
   {
   LineON=1;
   Von=1;
   MotorR_EN=MotorL_EN=1;
   
   if(ISO1==0)
   {
       LedD1=LedD2=LedD4=LedD5=LedD6=LedD7=LedD8=LedD9=LedD10=LedD11=LedD12=LedD13=0;
       MotorR_FORWARD=MotorL_FORWARD=1;
   }
else
{
   LedD1=LedD2=LedD4=LedD5=LedD6=LedD7=LedD8=LedD9=LedD10=LedD11=LedD12=LedD13=1;
   MotorR_FORWARD=MotorL_FORWARD=0;
}
  }while(1==1); 
}