main.cpp

00001 #include "mbed.h"
00002 
00003 // ************ DEKLARATIONEN **************
00004 DigitalOut Von (P2_13);           // Motor Spannung ab BERTL15 nötig !
00005 DigitalOut MotorL_EN(P1_19);      // Enable        OB DIE LINKS ODER RECHTS IST NOCH NICHT KLAR !    
00006 DigitalOut MotorL_FORWARD(P2_14); // Forwerts  
00007 DigitalOut MotorL_REVERSE(P2_15); // Rückwerts  
00008 
00009 DigitalOut MotorR_EN(P2_19);      //Die Leitung führt zum Pin PO_21 am Prozessor
00010 DigitalOut MotorR_FORWARD(P2_21); //Die Leitung führt zum Pin P1_3 am Prozessor
00011 DigitalOut MotorR_REVERSE(P2_20);
00012 
00013 // *************  Hauptprogramm ************
00014 int main() {                     // Start Hauptprogramm
00015     Von=1;                       // Motor Spannung EIN
00016     MotorR_EN=MotorL_EN=1;       // Beide Motoren ENABLE
00017     
00018     while(1)
00019      {  
00020         MotorR_FORWARD = 1;     
00021         MotorL_FORWARD = 1;   
00022         wait (1.0);
00023         MotorR_FORWARD = 0;
00024         MotorR_FORWARD = 1;
00025         wait(1.0);
00026         MotorR_FORWARD = 1;     
00027         MotorL_FORWARD = 1;     
00028         wait (1.0);
00029         MotorR_FORWARD = 0;
00030         MotorR_FORWARD = 1;
00031         MotorR_FORWARD = 1;     
00032         MotorL_FORWARD = 1;   
00033         wait (1.0);
00034         MotorR_FORWARD = 0;
00035         MotorR_FORWARD = 1;
00036         wait(1.0);
00037         MotorR_FORWARD = 1;     
00038         MotorL_FORWARD = 1;     
00039         wait (1.0);
00040         MotorR_FORWARD = 0;
00041         MotorR_FORWARD = 1;
00042       }
00043 }