B17 fährt vor und zurück (DigitalOut & wait)

Dependencies:   mbed

Fork of _B15_T4_Motor by Gottfried Enenkel

main.cpp

Committer:
Enenkel
Date:
2017-05-13
Revision:
3:02fb974f6bfb
Parent:
2:416e90645a22

File content as of revision 3:02fb974f6bfb:

/***************************************************************************
Name:   B17_Lektion03a                                      Motor VOR-ZURÜCK
Author: Gottfried Enenkel   HTL BULME
Email:  ene@bulme.at
Aufgabe:
    Ändere die Software so, dass
    der BERTL 0,5 sec vor
    und dann 0,5 sec zurück fährt
***************************************************************************/
#include "mbed.h"

// ************ DEKLARATIONEN **************
DigitalOut Von (P2_13);          // 10 V Versorgung einschalten !

// Motor MG1
DigitalOut MotorL_EN(P1_19);     // Enable
DigitalOut MotorL_FORWARD(P2_14);// Vorwerts
DigitalOut MotorL_REVERSE(P2_15);// Rückwerts
// MOTOR MG2
DigitalOut MotorR_EN(P2_19);      // Enable
DigitalOut MotorR_FORWARD(P2_20); // Vorwerts
DigitalOut MotorR_REVERSE(P1_4);  // Rückwerts 

// *************  Hauptprogramm ************
int main()                       // Start Hauptprogramm
{
    Von=1;                       // Motor Versorgunga 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     *********************************