B17 fährt ein 4 ECK

Dependencies:   mbed

Fork of _B15_T4_Motor by Gottfried Enenkel

main.cpp

Committer:
Enenkel
Date:
2017-05-13
Revision:
3:639110b96efb
Parent:
2:416e90645a22

File content as of revision 3:639110b96efb:

/***************************************************************************
Name:   B17_Lektion03c                                      4 ECK fahren
Author: Gottfried Enenkel   HTL BULME
Email:  ene@bulme.at
Aufgabe:
    Ändere die Software so, dass
    der BERTL 0,5 sec vor fährt
    und dann eine 90° Drehung macht ( nur ein Motor kurz ein)
    Die Übung ist fertig, wenn er ein schönes 4 Eck fährt
    Die Zeiten sind anzupassen.
    
    Vatiante 2
    Lass ihn einmal links herum fahren und einmal rechts herum !
    
    Variante 3
    lass ihn einmal komplett im Kreis fahren (nur ein Motor ein)
    (dancing BERTL)
***************************************************************************/
#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     *********************************