BULME_BERTL14 / Mbed 2 deprecated _B14Test6

Dependencies:   mbed

Committer:
Enenkel
Date:
Fri Nov 14 13:50:32 2014 +0000
Revision:
1:d0cca408dffe
Parent:
0:0b7c22955b8c
Child:
2:5f2dae8a94fa
Motor Sensoren

Who changed what in which revision?

UserRevisionLine numberNew contents of line
Enenkel 0:0b7c22955b8c 1 /***********************************
Enenkel 0:0b7c22955b8c 2 name: BERTL_2014_TEST
Enenkel 0:0b7c22955b8c 3 author: Gottfried Enenkel HTL BULME
Enenkel 0:0b7c22955b8c 4 email: ene@bulme.at
Enenkel 0:0b7c22955b8c 5 description:
Enenkel 0:0b7c22955b8c 6 Der BERTL fährt 1 sec lang VORWÄRTS!
Enenkel 0:0b7c22955b8c 7 Danach steht er für 1 sec
Enenkel 1:d0cca408dffe 8 Dabei sind die Radsensoren auf die D10 bzw. D13 geschalten.
Enenkel 0:0b7c22955b8c 9 Wenn an auf den Moter sieht, ist da + Zeichen
Enenkel 0:0b7c22955b8c 10 immer LINKS OBEN zu sehen !
Enenkel 0:0b7c22955b8c 11 ***********************************/
Enenkel 0:0b7c22955b8c 12 #include "mbed.h"
Enenkel 0:0b7c22955b8c 13
Enenkel 0:0b7c22955b8c 14 // ************ DEKLARATIONEN **************
Enenkel 1:d0cca408dffe 15 DigitalOut MotorL_EN(p34); // Motor Links = mg1
Enenkel 0:0b7c22955b8c 16 DigitalOut MotorL_FORWARD(P1_1);
Enenkel 0:0b7c22955b8c 17 DigitalOut MotorL_REVERSE(P1_0);
Enenkel 0:0b7c22955b8c 18
Enenkel 1:d0cca408dffe 19 DigitalOut MotorR_EN(p36); //Motor Rechts = mg2
Enenkel 0:0b7c22955b8c 20 DigitalOut MotorR_FORWARD(P1_3);
Enenkel 0:0b7c22955b8c 21 DigitalOut MotorR_REVERSE(P1_4);
Enenkel 0:0b7c22955b8c 22
Enenkel 1:d0cca408dffe 23 PwmOut mg1(p34); //PWM Ausgang zum Motor
Enenkel 1:d0cca408dffe 24 PwmOut mg2(p36);
Enenkel 1:d0cca408dffe 25 float speedy=0.2; //Motor speed
Enenkel 1:d0cca408dffe 26 // wenn kleiner als 0.2,
Enenkel 1:d0cca408dffe 27 // kann der Motor ev nicht mehr anfahren
Enenkel 1:d0cca408dffe 28 DigitalOut LED_D10(P1_8); // LED D10 und D13 definieren
Enenkel 1:d0cca408dffe 29 DigitalOut LED_D13(P1_11); //
Enenkel 1:d0cca408dffe 30
Enenkel 1:d0cca408dffe 31 DigitalIn SensorL(P1_12); // Sensor Links bei mg1
Enenkel 1:d0cca408dffe 32 DigitalIn SensorR(P1_13); // Sensor Rechts bei mg2
Enenkel 1:d0cca408dffe 33 int a; // Variable a
Enenkel 0:0b7c22955b8c 34 // ************* Hauptprogramm ************
Enenkel 0:0b7c22955b8c 35 int main() { // Start Hauptprogramm
Enenkel 1:d0cca408dffe 36 mg1=mg2=speedy;
Enenkel 1:d0cca408dffe 37 MotorR_EN=MotorL_EN=(1); // Beide Motoren ENABLE
Enenkel 1:d0cca408dffe 38
Enenkel 1:d0cca408dffe 39 while (1){
Enenkel 1:d0cca408dffe 40 a=0; //Variable a auf 0 setzen
Enenkel 1:d0cca408dffe 41 while(a<1000) { // mache solang a<1000
Enenkel 0:0b7c22955b8c 42 MotorR_FORWARD = MotorL_FORWARD = 1; // Beide Motoren vorwärts EIN
Enenkel 1:d0cca408dffe 43 LED_D10 = SensorL; // LED D10 blinkt
Enenkel 1:d0cca408dffe 44 LED_D13 = SensorR; // LED D13 blinkt
Enenkel 1:d0cca408dffe 45 a++;
Enenkel 1:d0cca408dffe 46 wait_ms(1); // warte 1 mSekunde
Enenkel 1:d0cca408dffe 47 }
Enenkel 0:0b7c22955b8c 48 MotorR_FORWARD = MotorL_FORWARD = 0; // Motoren AUS
Enenkel 1:d0cca408dffe 49 wait (1); // warte 1 Sekunde
Enenkel 1:d0cca408dffe 50 } // Springe zum Anfang der Schleife
Enenkel 0:0b7c22955b8c 51 }
Enenkel 0:0b7c22955b8c 52
Enenkel 0:0b7c22955b8c 53 // ************** ENDE *************