-> Bertl16 Firmware 1.0 -> fährt 2sec gerade aus -> blinkt 2x links -> bremslichter leuchten auf und er bleibt stehen -> dreht nach ca. 90° nach links -> und alles geht wieder von vorne los

Dependencies:   mbed

Committer:
Julien_Blue
Date:
Wed May 18 09:07:03 2016 +0000
Revision:
0:655bc033bb9d
Written by Julian Koller.

Who changed what in which revision?

UserRevisionLine numberNew contents of line
Julien_Blue 0:655bc033bb9d 1 /***********************************
Julien_Blue 0:655bc033bb9d 2 name: firware_1.0
Julien_Blue 0:655bc033bb9d 3 author: Julian Koller
Julien_Blue 0:655bc033bb9d 4 description:
Julien_Blue 0:655bc033bb9d 5 -> fährt 2sec gerade aus
Julien_Blue 0:655bc033bb9d 6 -> blinkt 2x links
Julien_Blue 0:655bc033bb9d 7 -> bremslichter leuchten auf und er bleibt stehen
Julien_Blue 0:655bc033bb9d 8 -> dreht nach ca. 90° nach links
Julien_Blue 0:655bc033bb9d 9 -> und alles geht wieder von vorne los
Julien_Blue 0:655bc033bb9d 10 ***********************************/
Julien_Blue 0:655bc033bb9d 11
Julien_Blue 0:655bc033bb9d 12 #include <mbed.h>
Julien_Blue 0:655bc033bb9d 13
Julien_Blue 0:655bc033bb9d 14 //Definition der Motoren
Julien_Blue 0:655bc033bb9d 15 DigitalOut Von (P2_13);
Julien_Blue 0:655bc033bb9d 16 DigitalOut MotorL_EN(P1_19);
Julien_Blue 0:655bc033bb9d 17 DigitalOut MotorL_REVERSE(P2_14);
Julien_Blue 0:655bc033bb9d 18 DigitalOut MotorL_FORWARD(P2_15);
Julien_Blue 0:655bc033bb9d 19
Julien_Blue 0:655bc033bb9d 20 DigitalOut MotorR_EN(P2_19);
Julien_Blue 0:655bc033bb9d 21 DigitalOut MotorR_REVERSE(P2_21);
Julien_Blue 0:655bc033bb9d 22 DigitalOut MotorR_FORWARD(P2_20);
Julien_Blue 0:655bc033bb9d 23
Julien_Blue 0:655bc033bb9d 24
Julien_Blue 0:655bc033bb9d 25 // Definition der LEDS als AUSGANGE
Julien_Blue 0:655bc033bb9d 26 DigitalOut LedD1 (P1_10);
Julien_Blue 0:655bc033bb9d 27 DigitalOut LedD2 (P1_11);
Julien_Blue 0:655bc033bb9d 28 DigitalOut LedD4 (P1_12);
Julien_Blue 0:655bc033bb9d 29 DigitalOut LedD5 (P1_13);
Julien_Blue 0:655bc033bb9d 30 DigitalOut LedD6 (P1_14);
Julien_Blue 0:655bc033bb9d 31 DigitalOut LedD7 (P1_15);
Julien_Blue 0:655bc033bb9d 32 DigitalOut LedD8 (P1_16);
Julien_Blue 0:655bc033bb9d 33 DigitalOut LedD9 (P1_17);
Julien_Blue 0:655bc033bb9d 34 DigitalOut LedD10 (P1_18);
Julien_Blue 0:655bc033bb9d 35 DigitalOut LedD11 (P2_16);
Julien_Blue 0:655bc033bb9d 36 DigitalOut LedD12 (P1_20);
Julien_Blue 0:655bc033bb9d 37 DigitalOut LedD13 (P1_21);
Julien_Blue 0:655bc033bb9d 38 DigitalOut BlueLed (P1_5);
Julien_Blue 0:655bc033bb9d 39
Julien_Blue 0:655bc033bb9d 40 // Hauptprogramm
Julien_Blue 0:655bc033bb9d 41 int main()
Julien_Blue 0:655bc033bb9d 42 {
Julien_Blue 0:655bc033bb9d 43 Von = 1;
Julien_Blue 0:655bc033bb9d 44 MotorL_EN = MotorR_EN = 1;
Julien_Blue 0:655bc033bb9d 45 LedD1 = LedD2 = LedD4 = LedD5 = LedD6 = LedD7 = LedD8 = LedD9 = LedD10 = LedD11 = LedD12 = LedD13 = BlueLed = 1;
Julien_Blue 0:655bc033bb9d 46
Julien_Blue 0:655bc033bb9d 47 do
Julien_Blue 0:655bc033bb9d 48 {
Julien_Blue 0:655bc033bb9d 49 LedD1 = LedD4 = BlueLed = 0;
Julien_Blue 0:655bc033bb9d 50
Julien_Blue 0:655bc033bb9d 51
Julien_Blue 0:655bc033bb9d 52 MotorL_FORWARD = MotorR_FORWARD = 1;
Julien_Blue 0:655bc033bb9d 53
Julien_Blue 0:655bc033bb9d 54 wait(2);
Julien_Blue 0:655bc033bb9d 55 LedD2 = LedD6 = 0;
Julien_Blue 0:655bc033bb9d 56 wait(0.5);
Julien_Blue 0:655bc033bb9d 57 LedD2 = LedD6 = 1;
Julien_Blue 0:655bc033bb9d 58 wait(0.5);
Julien_Blue 0:655bc033bb9d 59 LedD2 = LedD6 = 0;
Julien_Blue 0:655bc033bb9d 60 wait(0.5);
Julien_Blue 0:655bc033bb9d 61 LedD2 = LedD6 = 1;
Julien_Blue 0:655bc033bb9d 62 LedD7 = LedD9 = 0;
Julien_Blue 0:655bc033bb9d 63 wait(0.25);
Julien_Blue 0:655bc033bb9d 64
Julien_Blue 0:655bc033bb9d 65 MotorL_FORWARD = MotorR_FORWARD = 0;
Julien_Blue 0:655bc033bb9d 66
Julien_Blue 0:655bc033bb9d 67 wait(0.25);
Julien_Blue 0:655bc033bb9d 68 LedD7 = LedD9 = 1;
Julien_Blue 0:655bc033bb9d 69 LedD2 = LedD6 = 0;
Julien_Blue 0:655bc033bb9d 70 wait(0.5);
Julien_Blue 0:655bc033bb9d 71 LedD2 = LedD6 = 1;
Julien_Blue 0:655bc033bb9d 72 wait(0.5);
Julien_Blue 0:655bc033bb9d 73 LedD2 = LedD6 = 0;
Julien_Blue 0:655bc033bb9d 74 wait(0.5);
Julien_Blue 0:655bc033bb9d 75 LedD2 = LedD6 = 1;
Julien_Blue 0:655bc033bb9d 76 wait(0.5);
Julien_Blue 0:655bc033bb9d 77
Julien_Blue 0:655bc033bb9d 78 MotorR_FORWARD = 1;
Julien_Blue 0:655bc033bb9d 79
Julien_Blue 0:655bc033bb9d 80 wait(0.25);
Julien_Blue 0:655bc033bb9d 81 } while(1);
Julien_Blue 0:655bc033bb9d 82 }
Julien_Blue 0:655bc033bb9d 83