B17 fährt ein 4 ECK

Dependencies:   mbed

Fork of _B15_T4_Motor by Gottfried Enenkel

Committer:
Enenkel
Date:
Sat May 13 10:16:42 2017 +0000
Revision:
3:639110b96efb
Parent:
2:416e90645a22
B17_Lektion03c

Who changed what in which revision?

UserRevisionLine numberNew contents of line
Enenkel 3:639110b96efb 1 /***************************************************************************
Enenkel 3:639110b96efb 2 Name: B17_Lektion03c 4 ECK fahren
Enenkel 3:639110b96efb 3 Author: Gottfried Enenkel HTL BULME
Enenkel 3:639110b96efb 4 Email: ene@bulme.at
Enenkel 3:639110b96efb 5 Aufgabe:
Enenkel 3:639110b96efb 6 Ändere die Software so, dass
Enenkel 3:639110b96efb 7 der BERTL 0,5 sec vor fährt
Enenkel 3:639110b96efb 8 und dann eine 90° Drehung macht ( nur ein Motor kurz ein)
Enenkel 3:639110b96efb 9 Die Übung ist fertig, wenn er ein schönes 4 Eck fährt
Enenkel 3:639110b96efb 10 Die Zeiten sind anzupassen.
Enenkel 1:0f7c167a4f97 11
Enenkel 3:639110b96efb 12 Vatiante 2
Enenkel 3:639110b96efb 13 Lass ihn einmal links herum fahren und einmal rechts herum !
Enenkel 0:a8a0195ed7dc 14
Enenkel 3:639110b96efb 15 Variante 3
Enenkel 3:639110b96efb 16 lass ihn einmal komplett im Kreis fahren (nur ein Motor ein)
Enenkel 3:639110b96efb 17 (dancing BERTL)
Enenkel 3:639110b96efb 18 ***************************************************************************/
Enenkel 1:0f7c167a4f97 19 #include "mbed.h"
Enenkel 1:0f7c167a4f97 20
Enenkel 1:0f7c167a4f97 21 // ************ DEKLARATIONEN **************
Enenkel 3:639110b96efb 22 DigitalOut Von (P2_13); // 10 V Versorgung einschalten !
Enenkel 1:0f7c167a4f97 23
Enenkel 3:639110b96efb 24 // Motor MG1
Enenkel 3:639110b96efb 25 DigitalOut MotorL_EN(P1_19); // Enable
Enenkel 3:639110b96efb 26 DigitalOut MotorL_FORWARD(P2_14);// Vorwerts
Enenkel 3:639110b96efb 27 DigitalOut MotorL_REVERSE(P2_15);// Rückwerts
Enenkel 3:639110b96efb 28 // MOTOR MG2
Enenkel 3:639110b96efb 29 DigitalOut MotorR_EN(P2_19); // Enable
Enenkel 3:639110b96efb 30 DigitalOut MotorR_FORWARD(P2_20); // Vorwerts
Enenkel 3:639110b96efb 31 DigitalOut MotorR_REVERSE(P1_4); // Rückwerts
Enenkel 0:a8a0195ed7dc 32
Enenkel 1:0f7c167a4f97 33 // ************* Hauptprogramm ************
Enenkel 3:639110b96efb 34 int main() // Start Hauptprogramm
Enenkel 3:639110b96efb 35 {
Enenkel 3:639110b96efb 36 Von=1; // Motor Versorgunga Spannung EIN
Enenkel 1:0f7c167a4f97 37 MotorR_EN=MotorL_EN=1; // Beide Motoren ENABLE
Enenkel 3:639110b96efb 38
Enenkel 3:639110b96efb 39 while(1) { // Anfang der Schleife (ohne Abbruch)
Enenkel 3:639110b96efb 40 MotorR_FORWARD = 1; // RECHTER Motor vorwärts EIN
Enenkel 2:416e90645a22 41 MotorL_FORWARD = 1; // LINKER Motoren vorwärts EIN
Enenkel 3:639110b96efb 42 wait (1.0); // warte 1 Sekunde
Enenkel 3:639110b96efb 43
Enenkel 2:416e90645a22 44 MotorR_FORWARD = 0; // RECHTER Motor STOP
Enenkel 3:639110b96efb 45 MotorL_FORWARD = 0; // LINKER Motoren STOP
Enenkel 3:639110b96efb 46 wait (1.0); // warte 1 Sekunde
Enenkel 3:639110b96efb 47 } // Springe zum Anfang der Schleife
Enenkel 1:0f7c167a4f97 48 } // Ende des Hauptprogrammes
Enenkel 1:0f7c167a4f97 49
Enenkel 3:639110b96efb 50 // **************************** ENDE *********************************
Enenkel 1:0f7c167a4f97 51
Enenkel 1:0f7c167a4f97 52
Enenkel 1:0f7c167a4f97 53
Enenkel 1:0f7c167a4f97 54
Enenkel 1:0f7c167a4f97 55
Enenkel 1:0f7c167a4f97 56