Schaltet die Motoren des B17 ein und aus (je 1 sec)

Dependencies:   mbed

Fork of _B16_T3_Motor by Gottfried Enenkel

main.cpp

Committer:
Enenkel
Date:
2016-04-21
Revision:
3:acd2b6fdcd7f
Parent:
2:416e90645a22
Child:
4:b0d3112c1bc6

File content as of revision 3:acd2b6fdcd7f:

/***********************************
name:   BERTL_16_MOTOR_TEST  8.1.2016
author: Gottfried Enenkel   HTL BULME
email:  ene@bulme.at
description:
    Der BERTL fährt 1 sec lang  VORWÄRTS! 
    Danach steht er für 1 sec
    
    Wenn der Motor richtig eingebaut ist, 
    steht über dem Linken Anschluß ein PLUS
    Wenn sich der BERTL dreht, ist ein Motor verkehrt eingebaut. 
    
***********************************/
#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) {                   // Anfang der Schleife (ohne Abbruch)   
        MotorR_FORWARD = 1;      // RECHTER Motor vorwärts EIN 
        MotorL_FORWARD = 1;      // LINKER Motoren vorwärts EIN
        wait (1.0);              // warte 1 Sekunde  
        MotorR_FORWARD = 0;      // RECHTER Motor STOP
        MotorL_FORWARD = 0;      // LINKER Motoren STOP  
        wait (1.0);              // warte 1 Sekunde 
    }                            // Springe zum Anfang der Schleife 
}                                // Ende des Hauptprogrammes

// **************     ENDE     *************