Bertl Programm für den Motor, reagiert auf die Taster. (Falsche Richtung)

Dependencies:   mbed

BertTaster.cpp

Committer:
JulianSteinkellner
Date:
2016-06-08
Revision:
0:bd48d1bab7e6

File content as of revision 0:bd48d1bab7e6:

#include "mbed.h"

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 Von (P2_13);           // Motor Spannung ab BERTL15 nötig !
DigitalOut MotorL_EN(P1_19);      // Enable        OB DIE LINKS ODER RECHTS IST NOCH NICHT KLAR !    
DigitalOut MotorL_FORWARD(P2_14); // Forwerts  
DigitalOut MotorL_REVERSE(P2_15); // Rückwerts  

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);

DigitalIn TA1 (P1_23);      
DigitalIn TA2 (P1_24);
DigitalIn TA3 (P1_25);
DigitalIn TA4 (P1_26);
DigitalIn TA5 (P1_27);      
DigitalIn TA6 (P1_28);
DigitalIn TA7 (P1_30);
DigitalIn TA8 (P1_31); 

int main()
{
    Von = 1;
    MotorL_EN=MotorR_EN=1;
    
    do {
    if(TA4 == 0)
        {
            MotorR_FORWARD=MotorL_FORWARD=0;
            LedD10=LedD11=LedD12=LedD13=0;
            LedD1=LedD2=LedD4=LedD5=LedD6=LedD7=LedD8=LedD9=1;
            MotorR_REVERSE=1;
            MotorL_REVERSE=1;
            wait(0.5);
            MotorR_REVERSE=0;
            MotorL_REVERSE=0;
            wait(0.5);
            MotorR_REVERSE=1;
            wait(0.35);
            MotorR_REVERSE=0;
            wait(0.5); 
        }
   MotorR_FORWARD=MotorL_FORWARD=1;
   if(TA6 == 0)
        {
            MotorR_FORWARD=MotorL_FORWARD=0;
            LedD10=LedD11=LedD12=LedD13=0;
            LedD1=LedD2=LedD4=LedD5=LedD6=LedD7=LedD8=LedD9=1;
            MotorR_REVERSE=1;
            MotorL_REVERSE=1;
            wait(0.5);
            MotorR_REVERSE=0;
            MotorL_REVERSE=0;
            wait(0.5);
            MotorL_REVERSE=1;
            wait(0.35);
            MotorL_REVERSE=0;
            wait(0.5);
        }
    MotorR_FORWARD=MotorL_FORWARD=1;
    if(TA5 == 0)
        {
            MotorR_FORWARD=MotorL_FORWARD=0;
            LedD10=LedD11=LedD12=LedD13=0;
            LedD1=LedD2=LedD4=LedD5=LedD6=LedD7=LedD8=LedD9=1;
            MotorR_REVERSE=1;
            MotorL_REVERSE=1;
            wait(0.5);
            MotorR_REVERSE=0;
            MotorL_REVERSE=0;
            wait(0.5);
            MotorR_REVERSE=1;
            wait(0.35);
            MotorR_REVERSE=0;
            wait(0.5);
        }
    MotorR_FORWARD=MotorL_FORWARD=1;
    if(TA2 == 0)
    {
            MotorR_FORWARD=MotorL_FORWARD=0;
            LedD10=LedD11=LedD12=LedD13=0;
            LedD1=LedD2=LedD4=LedD5=LedD6=LedD7=LedD8=LedD9=1;
            MotorR_FORWARD=MotorL_FORWARD=1;
            wait(1.0);
            MotorR_FORWARD=MotorL_FORWARD=0;
            wait(0.5);
    }
    MotorR_FORWARD=MotorL_FORWARD=1;
    
    if(TA3 == 0)
    {
            MotorR_FORWARD=MotorL_FORWARD=0;
            LedD10=LedD11=LedD12=LedD13=0;
            LedD1=LedD2=LedD4=LedD5=LedD6=LedD7=LedD8=LedD9=1;
            MotorR_FORWARD=MotorL_FORWARD=1;
            wait(1.0);
            MotorR_FORWARD=MotorL_FORWARD=0;
            wait(0.5);
    }
    MotorR_FORWARD=MotorL_FORWARD=1;
    if(TA8 == 0)
    {
            MotorR_FORWARD=MotorL_FORWARD=0;
            LedD10=LedD11=LedD12=LedD13=0;
            LedD1=LedD2=LedD4=LedD5=LedD6=LedD7=LedD8=LedD9=1;
            MotorL_FORWARD=1;
            wait(0.2);
            MotorL_FORWARD=0;
    }
    MotorR_FORWARD=MotorL_FORWARD=1;
    if(TA7 == 0)
    {
            MotorR_FORWARD=MotorL_FORWARD=0;
            LedD10=LedD11=LedD12=LedD13=0;
            LedD1=LedD2=LedD4=LedD5=LedD6=LedD7=LedD8=LedD9=1;
            MotorL_FORWARD=1;
            wait(0.2);
            MotorL_FORWARD=0;
    }
    MotorR_FORWARD=MotorL_FORWARD=1;
    }while(1);
}