Fährt 4*2 Kurven und stoppt dann
Dependencies: mbed
Fork of _B16_T3_Motor by
main.cpp@3:acd2b6fdcd7f, 2016-04-21 (annotated)
- Committer:
- Enenkel
- Date:
- Thu Apr 21 12:17:28 2016 +0000
- Revision:
- 3:acd2b6fdcd7f
- Parent:
- 2:416e90645a22
- Child:
- 4:2bf2ab6a1163
BERTL16 Motor Test
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
Enenkel | 0:a8a0195ed7dc | 1 | /*********************************** |
Enenkel | 3:acd2b6fdcd7f | 2 | name: BERTL_16_MOTOR_TEST 8.1.2016 |
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 | 3:acd2b6fdcd7f | 17 | DigitalOut Von (P2_13); // Motor Spannung ab BERTL15 nötig ! |
Enenkel | 3:acd2b6fdcd7f | 18 | DigitalOut MotorL_EN(P1_19); // Enable OB DIE LINKS ODER RECHTS IST NOCH NICHT KLAR ! |
Enenkel | 3:acd2b6fdcd7f | 19 | DigitalOut MotorL_FORWARD(P2_14); // Forwerts |
Enenkel | 3:acd2b6fdcd7f | 20 | DigitalOut MotorL_REVERSE(P2_15); // Rückwerts |
Enenkel | 1:0f7c167a4f97 | 21 | |
Enenkel | 3:acd2b6fdcd7f | 22 | DigitalOut MotorR_EN(P2_19); //Die Leitung führt zum Pin PO_21 am Prozessor |
Enenkel | 3:acd2b6fdcd7f | 23 | DigitalOut MotorR_FORWARD(P2_21); //Die Leitung führt zum Pin P1_3 am Prozessor |
Enenkel | 3:acd2b6fdcd7f | 24 | DigitalOut MotorR_REVERSE(P2_20); |
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 | 2:416e90645a22 | 31 | MotorR_FORWARD = 1; // RECHTER Motor vorwärts EIN |
Enenkel | 2:416e90645a22 | 32 | MotorL_FORWARD = 1; // LINKER Motoren vorwärts EIN |
Enenkel | 1:0f7c167a4f97 | 33 | wait (1.0); // warte 1 Sekunde |
Enenkel | 2:416e90645a22 | 34 | MotorR_FORWARD = 0; // RECHTER Motor STOP |
Enenkel | 2:416e90645a22 | 35 | MotorL_FORWARD = 0; // LINKER Motoren STOP |
Enenkel | 1:0f7c167a4f97 | 36 | wait (1.0); // warte 1 Sekunde |
Enenkel | 1:0f7c167a4f97 | 37 | } // Springe zum Anfang der Schleife |
Enenkel | 1:0f7c167a4f97 | 38 | } // Ende des Hauptprogrammes |
Enenkel | 1:0f7c167a4f97 | 39 | |
Enenkel | 1:0f7c167a4f97 | 40 | // ************** ENDE ************* |
Enenkel | 1:0f7c167a4f97 | 41 | |
Enenkel | 1:0f7c167a4f97 | 42 | |
Enenkel | 1:0f7c167a4f97 | 43 | |
Enenkel | 1:0f7c167a4f97 | 44 | |
Enenkel | 1:0f7c167a4f97 | 45 | |
Enenkel | 1:0f7c167a4f97 | 46 |