Fährt 4*2 Kurven und stoppt dann
Dependencies: mbed
Fork of _B16_T3_Motor by
main.cpp@1:0f7c167a4f97, 2015-05-31 (annotated)
- 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?
User | Revision | Line number | New 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 |