Christian Lukas / Mbed 2 deprecated motorfahrt

Dependencies:   mbed

Committer:
chipsian
Date:
Wed Jun 08 11:25:58 2016 +0000
Revision:
0:28e3f0945e35
This is a programm for fun, you could say it's a show

Who changed what in which revision?

UserRevisionLine numberNew contents of line
chipsian 0:28e3f0945e35 1 /***********************************
chipsian 0:28e3f0945e35 2 name: BERTL_16_MOTOR_TEST 8.1.2016
chipsian 0:28e3f0945e35 3 author: Gottfried Enenkel HTL BULME
chipsian 0:28e3f0945e35 4 email: ene@bulme.at
chipsian 0:28e3f0945e35 5 description:
chipsian 0:28e3f0945e35 6 Der BERTL fährt 1 sec lang VORWÄRTS!
chipsian 0:28e3f0945e35 7 Danach steht er für 1 sec
chipsian 0:28e3f0945e35 8
chipsian 0:28e3f0945e35 9 Wenn der Motor richtig eingebaut ist,
chipsian 0:28e3f0945e35 10 steht über dem Linken Anschluß ein PLUS
chipsian 0:28e3f0945e35 11 Wenn sich der BERTL dreht, ist ein Motor verkehrt eingebaut.
chipsian 0:28e3f0945e35 12
chipsian 0:28e3f0945e35 13 ***********************************/
chipsian 0:28e3f0945e35 14 #include "mbed.h"
chipsian 0:28e3f0945e35 15
chipsian 0:28e3f0945e35 16 // ************ DEKLARATIONEN **************
chipsian 0:28e3f0945e35 17 DigitalOut Von (P2_13); // Motor Spannung ab BERTL15 nötig !
chipsian 0:28e3f0945e35 18 DigitalOut MotorL_EN(P1_19); // Enable OB DIE LINKS ODER RECHTS IST NOCH NICHT KLAR !
chipsian 0:28e3f0945e35 19 DigitalOut MotorL_FORWARD(P2_14); // Forwerts
chipsian 0:28e3f0945e35 20 DigitalOut MotorL_REVERSE(P2_15); // Rückwerts
chipsian 0:28e3f0945e35 21
chipsian 0:28e3f0945e35 22 DigitalOut MotorR_EN(P2_19); //Die Leitung führt zum Pin PO_21 am Prozessor
chipsian 0:28e3f0945e35 23 DigitalOut MotorR_FORWARD(P2_21); //Die Leitung führt zum Pin P1_3 am Prozessor
chipsian 0:28e3f0945e35 24 DigitalOut MotorR_REVERSE(P2_20);
chipsian 0:28e3f0945e35 25
chipsian 0:28e3f0945e35 26 DigitalOut _LED1 (P1_10);
chipsian 0:28e3f0945e35 27 DigitalOut _LED2 (P1_11);
chipsian 0:28e3f0945e35 28 DigitalOut _LED3 (P1_12);
chipsian 0:28e3f0945e35 29 DigitalOut _LED4 (P1_12);
chipsian 0:28e3f0945e35 30 DigitalOut _LED5 (P1_13);
chipsian 0:28e3f0945e35 31 DigitalOut _LED6 (P1_14);
chipsian 0:28e3f0945e35 32 DigitalOut _LED7 (P1_15);
chipsian 0:28e3f0945e35 33 DigitalOut _LED8 (P1_16);
chipsian 0:28e3f0945e35 34 DigitalOut _LED9 (P1_17);
chipsian 0:28e3f0945e35 35 DigitalOut _LED10 (P1_18);
chipsian 0:28e3f0945e35 36 DigitalOut _LED11 (P2_16);
chipsian 0:28e3f0945e35 37 DigitalOut _LED12 (P1_20);
chipsian 0:28e3f0945e35 38 DigitalOut _LED13 (P1_21);
chipsian 0:28e3f0945e35 39 DigitalOut _LED20 (P1_5);
chipsian 0:28e3f0945e35 40 DigitalOut _LED24 (P1_5);
chipsian 0:28e3f0945e35 41 DigitalOut _LED25 (P1_6);
chipsian 0:28e3f0945e35 42 DigitalOut TA1 (P1_23);
chipsian 0:28e3f0945e35 43
chipsian 0:28e3f0945e35 44 // ************* Hauptprogramm ************
chipsian 0:28e3f0945e35 45 int main()
chipsian 0:28e3f0945e35 46
chipsian 0:28e3f0945e35 47 {
chipsian 0:28e3f0945e35 48 _LED1 = 1;
chipsian 0:28e3f0945e35 49 wait(0.1); _LED1 = 0;
chipsian 0:28e3f0945e35 50
chipsian 0:28e3f0945e35 51 _LED2 = 1;
chipsian 0:28e3f0945e35 52 wait(0.1); _LED2 = 0;
chipsian 0:28e3f0945e35 53
chipsian 0:28e3f0945e35 54 _LED3 = 1;
chipsian 0:28e3f0945e35 55 wait(0.1); _LED3 = 0;
chipsian 0:28e3f0945e35 56
chipsian 0:28e3f0945e35 57 _LED4 = 1;
chipsian 0:28e3f0945e35 58 wait(0.1); _LED4 = 0;
chipsian 0:28e3f0945e35 59
chipsian 0:28e3f0945e35 60 _LED5 = 1;
chipsian 0:28e3f0945e35 61 wait(0.1); _LED5 = 0;
chipsian 0:28e3f0945e35 62
chipsian 0:28e3f0945e35 63 _LED6 = 1;
chipsian 0:28e3f0945e35 64 wait(0.1); _LED6 = 0;
chipsian 0:28e3f0945e35 65
chipsian 0:28e3f0945e35 66 _LED7 = 1;
chipsian 0:28e3f0945e35 67 wait(0.1); _LED7 = 0;
chipsian 0:28e3f0945e35 68
chipsian 0:28e3f0945e35 69 _LED8 = 1;
chipsian 0:28e3f0945e35 70 wait(0.1); _LED8 = 0;
chipsian 0:28e3f0945e35 71
chipsian 0:28e3f0945e35 72 _LED9 = 1;
chipsian 0:28e3f0945e35 73 wait(0.1); _LED9 = 0;
chipsian 0:28e3f0945e35 74
chipsian 0:28e3f0945e35 75 _LED10 = 1;
chipsian 0:28e3f0945e35 76 wait(0.1); _LED10 = 0;
chipsian 0:28e3f0945e35 77
chipsian 0:28e3f0945e35 78 _LED11 = 1;
chipsian 0:28e3f0945e35 79 wait(0.1); _LED11 = 0;
chipsian 0:28e3f0945e35 80
chipsian 0:28e3f0945e35 81 _LED12 = 1;
chipsian 0:28e3f0945e35 82 wait(0.1); _LED12 = 0;
chipsian 0:28e3f0945e35 83
chipsian 0:28e3f0945e35 84 _LED20 = 1;
chipsian 0:28e3f0945e35 85 wait(0.1); _LED20 = 0;
chipsian 0:28e3f0945e35 86
chipsian 0:28e3f0945e35 87 _LED24 = 1;
chipsian 0:28e3f0945e35 88 wait(0.1); _LED24 = 0;
chipsian 0:28e3f0945e35 89
chipsian 0:28e3f0945e35 90 _LED25 = 1;
chipsian 0:28e3f0945e35 91 wait(0.1); _LED25 = 0;
chipsian 0:28e3f0945e35 92
chipsian 0:28e3f0945e35 93 TA1 = 1;
chipsian 0:28e3f0945e35 94 wait(0.1); TA1 = 0;
chipsian 0:28e3f0945e35 95
chipsian 0:28e3f0945e35 96
chipsian 0:28e3f0945e35 97
chipsian 0:28e3f0945e35 98
chipsian 0:28e3f0945e35 99 Von=1;
chipsian 0:28e3f0945e35 100 MotorR_EN=MotorL_EN=1;
chipsian 0:28e3f0945e35 101 { // Start Hauptprogramm
chipsian 0:28e3f0945e35 102 Von=1; // Motor Spannung EIN
chipsian 0:28e3f0945e35 103 MotorR_EN=MotorL_EN=1; // Beide Motoren ENABLE
chipsian 0:28e3f0945e35 104 while(1) { // Anfang der Schleife (ohne Abbruch)
chipsian 0:28e3f0945e35 105 MotorR_FORWARD = 1; // RECHTER Motor vorwärts EIN
chipsian 0:28e3f0945e35 106 MotorL_REVERSE = 1; // LINKER Motoren vorwärts EIN
chipsian 0:28e3f0945e35 107 wait (3.0) ; // warte 5 sekunden
chipsian 0:28e3f0945e35 108
chipsian 0:28e3f0945e35 109 MotorR_FORWARD = 0;
chipsian 0:28e3f0945e35 110 MotorL_REVERSE = 1;
chipsian 0:28e3f0945e35 111 wait (2.0);
chipsian 0:28e3f0945e35 112
chipsian 0:28e3f0945e35 113 MotorL_REVERSE = 0;
chipsian 0:28e3f0945e35 114 MotorR_FORWARD = 1;
chipsian 0:28e3f0945e35 115 MotorL_FORWARD = 1;
chipsian 0:28e3f0945e35 116 wait (1.0);
chipsian 0:28e3f0945e35 117
chipsian 0:28e3f0945e35 118 MotorR_FORWARD = 0;
chipsian 0:28e3f0945e35 119 MotorL_FORWARD = 0;
chipsian 0:28e3f0945e35 120 MotorR_REVERSE = 1;
chipsian 0:28e3f0945e35 121 MotorL_REVERSE = 1;
chipsian 0:28e3f0945e35 122 wait(2.0);
chipsian 0:28e3f0945e35 123
chipsian 0:28e3f0945e35 124 MotorL_REVERSE = 0;
chipsian 0:28e3f0945e35 125 MotorR_REVERSE = 1;
chipsian 0:28e3f0945e35 126 MotorL_FORWARD = 1;
chipsian 0:28e3f0945e35 127 wait(1.0);
chipsian 0:28e3f0945e35 128
chipsian 0:28e3f0945e35 129
chipsian 0:28e3f0945e35 130 MotorL_FORWARD = 0;
chipsian 0:28e3f0945e35 131 MotorR_REVERSE = 1;
chipsian 0:28e3f0945e35 132 MotorL_FORWARD = 0;
chipsian 0:28e3f0945e35 133 wait (0.1);
chipsian 0:28e3f0945e35 134
chipsian 0:28e3f0945e35 135 MotorR_REVERSE = 0;
chipsian 0:28e3f0945e35 136 MotorL_FORWARD = 1;
chipsian 0:28e3f0945e35 137 wait(2.0);
chipsian 0:28e3f0945e35 138
chipsian 0:28e3f0945e35 139
chipsian 0:28e3f0945e35 140
chipsian 0:28e3f0945e35 141 } // Springe zum Anfang der Schleife
chipsian 0:28e3f0945e35 142 } // Ende des Hauptprogrammes
chipsian 0:28e3f0945e35 143
chipsian 0:28e3f0945e35 144 }