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

Dependencies:   mbed

Fork of _B16_T3_Motor by Gottfried Enenkel

Committer:
Enenkel
Date:
Sun May 31 16:35:31 2015 +0000
Revision:
1:0f7c167a4f97
Parent:
0:a8a0195ed7dc
Child:
2:416e90645a22
B15 Motor Test

Who changed what in which revision?

UserRevisionLine numberNew contents of line
Enenkel 0:a8a0195ed7dc 1 /***********************************
Enenkel 1:0f7c167a4f97 2 name: BERTL_2015_MOTOR_TEST
Enenkel 1:0f7c167a4f97 3 author: Gottfried Enenkel HTL BULME
Enenkel 1:0f7c167a4f97 4 email: ene@bulme.at
Enenkel 0:a8a0195ed7dc 5 description:
Enenkel 1:0f7c167a4f97 6 Der BERTL fährt 1 sec lang VORWÄRTS!
Enenkel 1:0f7c167a4f97 7 Danach steht er für 1 sec
Enenkel 1:0f7c167a4f97 8
Enenkel 1:0f7c167a4f97 9 Wenn der Motor richtig eingebaut ist,
Enenkel 1:0f7c167a4f97 10 steht über dem Linken Anschluß ein PLUS
Enenkel 1:0f7c167a4f97 11 Wenn sich der BERTL dreht, ist ein Motor verkehrt eingebaut.
Enenkel 0:a8a0195ed7dc 12
Enenkel 1:0f7c167a4f97 13 ***********************************/
Enenkel 1:0f7c167a4f97 14 #include "mbed.h"
Enenkel 1:0f7c167a4f97 15
Enenkel 1:0f7c167a4f97 16 // ************ DEKLARATIONEN **************
Enenkel 1:0f7c167a4f97 17 DigitalOut Von (P1_2); // Motor Spannung ab BERTL15 nötig !
Enenkel 1:0f7c167a4f97 18 DigitalOut MotorL_EN(P1_15); // Enable
Enenkel 1:0f7c167a4f97 19 DigitalOut MotorL_FORWARD(P1_1); // Forwerts
Enenkel 1:0f7c167a4f97 20 DigitalOut MotorL_REVERSE(P1_0); // Rückwerts
Enenkel 1:0f7c167a4f97 21
Enenkel 1:0f7c167a4f97 22 DigitalOut MotorR_EN(P0_21); //Die Leitung führt zum Pin PO_21 am Prozessor
Enenkel 1:0f7c167a4f97 23 DigitalOut MotorR_FORWARD(P1_3); //Die Leitung führt zum Pin P1_3 am Prozessor
Enenkel 1:0f7c167a4f97 24 DigitalOut MotorR_REVERSE(P1_4);
Enenkel 0:a8a0195ed7dc 25
Enenkel 1:0f7c167a4f97 26 // ************* Hauptprogramm ************
Enenkel 1:0f7c167a4f97 27 int main() { // Start Hauptprogramm
Enenkel 1:0f7c167a4f97 28 Von=1; // Motor Spannung EIN
Enenkel 1:0f7c167a4f97 29 MotorR_EN=MotorL_EN=1; // Beide Motoren ENABLE
Enenkel 1:0f7c167a4f97 30 while(1) { // Anfang der Schleife (ohne Abbruch)
Enenkel 1:0f7c167a4f97 31 MotorR_FORWARD = MotorL_FORWARD = 1; // Beide Motoren vorwärts EIN
Enenkel 1:0f7c167a4f97 32 wait (1.0); // warte 1 Sekunde
Enenkel 1:0f7c167a4f97 33 MotorR_FORWARD = MotorL_FORWARD = 0; // Motoren AUS
Enenkel 1:0f7c167a4f97 34 wait (1.0); // warte 1 Sekunde
Enenkel 1:0f7c167a4f97 35 } // Springe zum Anfang der Schleife
Enenkel 1:0f7c167a4f97 36 } // Ende des Hauptprogrammes
Enenkel 1:0f7c167a4f97 37
Enenkel 1:0f7c167a4f97 38 // ************** ENDE *************
Enenkel 1:0f7c167a4f97 39
Enenkel 1:0f7c167a4f97 40
Enenkel 1:0f7c167a4f97 41
Enenkel 1:0f7c167a4f97 42
Enenkel 1:0f7c167a4f97 43
Enenkel 1:0f7c167a4f97 44