Quadrat fahren

Dependencies:   mbed

main.cpp

Committer:
simonmacher
Date:
2017-05-02
Revision:
0:7ec47c516da5

File content as of revision 0:7ec47c516da5:

#include "mbed.h"

// ************ DEKLARATIONEN **************
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);

// *************  Hauptprogramm ************
int main() {                     // Start Hauptprogramm
    Von=1;                       // Motor Spannung EIN
    MotorR_EN=MotorL_EN=1;       // Beide Motoren ENABLE
    
    while(1)
     {  
        MotorR_FORWARD = 1;     
        MotorL_FORWARD = 1;   
        wait (1.0);
        MotorR_FORWARD = 0;
        MotorR_FORWARD = 1;
        wait(1.0);
        MotorR_FORWARD = 1;     
        MotorL_FORWARD = 1;     
        wait (1.0);
        MotorR_FORWARD = 0;
        MotorR_FORWARD = 1;
        MotorR_FORWARD = 1;     
        MotorL_FORWARD = 1;   
        wait (1.0);
        MotorR_FORWARD = 0;
        MotorR_FORWARD = 1;
        wait(1.0);
        MotorR_FORWARD = 1;     
        MotorL_FORWARD = 1;     
        wait (1.0);
        MotorR_FORWARD = 0;
        MotorR_FORWARD = 1;
      }
}