Schaltet die Bertl17 Motoren ein und aus. Dies im 1 Sec Takt. Kontrolliere ob beide Motoren in die gleiche Richtung drehen.

Dependencies:   mbed

Embed: (wiki syntax)

« Back to documentation index

Show/hide line numbers main.cpp Source File

main.cpp

00001 /***********************************
00002 name:   BERTL_16_MOTOR_TEST  8.1.2016
00003 author: Gottfried Enenkel   HTL BULME
00004 email:  ene@bulme.at
00005 description:
00006     Der BERTL fährt 1 sec lang  VORWÄRTS! 
00007     Danach steht er für 1 sec
00008     
00009     Wenn der Motor richtig eingebaut ist, 
00010     steht über dem Linken Anschluß ein PLUS
00011     Wenn sich der BERTL dreht, ist ein Motor verkehrt eingebaut. 
00012     
00013 ***********************************/
00014 #include "mbed.h"
00015 
00016 // ************ DEKLARATIONEN **************
00017 DigitalOut Von (P2_13);           // Motor Spannung ab BERTL15 nötig !
00018 DigitalOut MotorL_EN(P1_19);      // Enable        OB DIE LINKS ODER RECHTS IST NOCH NICHT KLAR !    
00019 DigitalOut MotorL_FORWARD(P2_14); // Forwerts  
00020 DigitalOut MotorL_REVERSE(P2_15); // Rückwerts  
00021 
00022 DigitalOut MotorR_EN(P2_19);      //Die Leitung führt zum Pin PO_21 am Prozessor
00023 DigitalOut MotorR_FORWARD(P2_21); //Die Leitung führt zum Pin P1_3 am Prozessor
00024 DigitalOut MotorR_REVERSE(P2_20);
00025 
00026 // *************  Hauptprogramm ************
00027 int main() {                     // Start Hauptprogramm
00028     Von=1;   
00029     wait (1.0);                   // Motor Spannung EIN
00030     MotorR_EN=MotorL_EN=1;       // Beide Motoren ENABLE
00031     while(1) {                   // Anfang der Schleife (ohne Abbruch)   
00032         MotorR_FORWARD = 1;      // RECHTER Motor vorwärts EIN 
00033         MotorL_FORWARD = 1;      // LINKER Motoren vorwärts EIN
00034         wait (1.0);              // warte 1 Sekunde  
00035         MotorR_FORWARD = 0;      // RECHTER Motor STOP
00036         MotorL_FORWARD = 0;      // LINKER Motoren STOP  
00037         wait (1.0);              // warte 1 Sekunde 
00038     }                            // Springe zum Anfang der Schleife 
00039 }                                // Ende des Hauptprogrammes
00040 
00041 // **************     ENDE     *************
00042 
00043 
00044 
00045 
00046 
00047