Sebastian Gsellmann / Mbed 2 deprecated Bertel_mit_Tasern

Bertel fährt mit Tastern

Dependencies:   mbed

main.cpp@0:6732508afb31, 2016-06-06 (annotated)

Committer:
Gsellmann_Sebastian
Date:
Mon Jun 06 10:37:05 2016 +0000
Revision:
0:6732508afb31
Bertel f?hrt mit Tastern

Who changed what in which revision?

UserRevisionLine numberNew contents of line
Gsellmann_Sebastian 0:6732508afb31 1 #include "mbed.h"
Gsellmann_Sebastian 0:6732508afb31 2
Gsellmann_Sebastian 0:6732508afb31 3 DigitalOut Von (P2_13); // Motor Spannung ab BERTL15 nötig !
Gsellmann_Sebastian 0:6732508afb31 4 DigitalOut MotorL_EN(P1_19); // Enable OB DIE LINKS ODER RECHTS IST NOCH NICHT KLAR !
Gsellmann_Sebastian 0:6732508afb31 5 DigitalOut MotorL_FORWARD(P2_14); // Forwerts
Gsellmann_Sebastian 0:6732508afb31 6 DigitalOut MotorL_REVERSE(P2_15); // Rückwerts
Gsellmann_Sebastian 0:6732508afb31 7
Gsellmann_Sebastian 0:6732508afb31 8 DigitalOut MotorR_EN(P2_19); //Die Leitung führt zum Pin PO_21 am Prozessor
Gsellmann_Sebastian 0:6732508afb31 9 DigitalOut MotorR_FORWARD(P2_21); //Die Leitung führt zum Pin P1_3 am Prozessor
Gsellmann_Sebastian 0:6732508afb31 10 DigitalOut MotorR_REVERSE(P2_20);
Gsellmann_Sebastian 0:6732508afb31 11
Gsellmann_Sebastian 0:6732508afb31 12 DigitalIn TA1 (P1_23);
Gsellmann_Sebastian 0:6732508afb31 13 DigitalIn TA2 (P1_24);
Gsellmann_Sebastian 0:6732508afb31 14 DigitalIn TA3 (P1_25);
Gsellmann_Sebastian 0:6732508afb31 15 DigitalIn TA4 (P1_26);
Gsellmann_Sebastian 0:6732508afb31 16 DigitalIn TA5 (P1_27);
Gsellmann_Sebastian 0:6732508afb31 17 DigitalIn TA6 (P1_28);
Gsellmann_Sebastian 0:6732508afb31 18 DigitalIn TA7 (P1_30);
Gsellmann_Sebastian 0:6732508afb31 19 DigitalIn TA8 (P1_31);
Gsellmann_Sebastian 0:6732508afb31 20
Gsellmann_Sebastian 0:6732508afb31 21
Gsellmann_Sebastian 0:6732508afb31 22
Gsellmann_Sebastian 0:6732508afb31 23
Gsellmann_Sebastian 0:6732508afb31 24
Gsellmann_Sebastian 0:6732508afb31 25 DigitalOut LedD6 (P1_14);
Gsellmann_Sebastian 0:6732508afb31 26 DigitalOut LedD7 (P1_15);
Gsellmann_Sebastian 0:6732508afb31 27 DigitalOut LedD8 (P1_16);
Gsellmann_Sebastian 0:6732508afb31 28 DigitalOut LedD9 (P1_17);
Gsellmann_Sebastian 0:6732508afb31 29
Gsellmann_Sebastian 0:6732508afb31 30
Gsellmann_Sebastian 0:6732508afb31 31 int main() { // Start Hauptprogramm
Gsellmann_Sebastian 0:6732508afb31 32 Von=1; // Motor Spannung EIN
Gsellmann_Sebastian 0:6732508afb31 33 MotorR_EN=MotorL_EN=1;
Gsellmann_Sebastian 0:6732508afb31 34
Gsellmann_Sebastian 0:6732508afb31 35 while(1) {
Gsellmann_Sebastian 0:6732508afb31 36
Gsellmann_Sebastian 0:6732508afb31 37 if (TA8==1){ //ggf
Gsellmann_Sebastian 0:6732508afb31 38 MotorL_REVERSE=1;
Gsellmann_Sebastian 0:6732508afb31 39 MotorR_REVERSE=1;
Gsellmann_Sebastian 0:6732508afb31 40 LedD7 = 1;
Gsellmann_Sebastian 0:6732508afb31 41 LedD9 = 1;
Gsellmann_Sebastian 0:6732508afb31 42
Gsellmann_Sebastian 0:6732508afb31 43 }else {
Gsellmann_Sebastian 0:6732508afb31 44 {
Gsellmann_Sebastian 0:6732508afb31 45
Gsellmann_Sebastian 0:6732508afb31 46 LedD7 = 0;
Gsellmann_Sebastian 0:6732508afb31 47 LedD9 = 0;
Gsellmann_Sebastian 0:6732508afb31 48 MotorL_REVERSE=0;
Gsellmann_Sebastian 0:6732508afb31 49 MotorR_REVERSE=0;
Gsellmann_Sebastian 0:6732508afb31 50 MotorR_FORWARD=1;
Gsellmann_Sebastian 0:6732508afb31 51 MotorL_FORWARD=1;
Gsellmann_Sebastian 0:6732508afb31 52 wait(0.5);
Gsellmann_Sebastian 0:6732508afb31 53 MotorL_FORWARD=0;
Gsellmann_Sebastian 0:6732508afb31 54 wait(0.5);
Gsellmann_Sebastian 0:6732508afb31 55 MotorR_FORWARD=0;
Gsellmann_Sebastian 0:6732508afb31 56 MotorL_REVERSE=1;
Gsellmann_Sebastian 0:6732508afb31 57 MotorR_REVERSE=1;
Gsellmann_Sebastian 0:6732508afb31 58 }}
Gsellmann_Sebastian 0:6732508afb31 59
Gsellmann_Sebastian 0:6732508afb31 60 if (TA3==1){ //ggf
Gsellmann_Sebastian 0:6732508afb31 61 MotorL_REVERSE=1;
Gsellmann_Sebastian 0:6732508afb31 62 MotorR_REVERSE=1;
Gsellmann_Sebastian 0:6732508afb31 63 LedD7 = 1;
Gsellmann_Sebastian 0:6732508afb31 64 LedD9 = 1;
Gsellmann_Sebastian 0:6732508afb31 65
Gsellmann_Sebastian 0:6732508afb31 66 }else {
Gsellmann_Sebastian 0:6732508afb31 67 {
Gsellmann_Sebastian 0:6732508afb31 68
Gsellmann_Sebastian 0:6732508afb31 69 LedD7 = 0;
Gsellmann_Sebastian 0:6732508afb31 70 LedD9 = 0;
Gsellmann_Sebastian 0:6732508afb31 71 MotorL_REVERSE=0;
Gsellmann_Sebastian 0:6732508afb31 72 MotorR_REVERSE=0;
Gsellmann_Sebastian 0:6732508afb31 73 MotorR_FORWARD=1;
Gsellmann_Sebastian 0:6732508afb31 74 MotorL_FORWARD=1;
Gsellmann_Sebastian 0:6732508afb31 75 wait(0.5);
Gsellmann_Sebastian 0:6732508afb31 76 MotorL_FORWARD=0;
Gsellmann_Sebastian 0:6732508afb31 77 wait(0.5);
Gsellmann_Sebastian 0:6732508afb31 78 MotorR_FORWARD=0;
Gsellmann_Sebastian 0:6732508afb31 79 MotorL_REVERSE=1;
Gsellmann_Sebastian 0:6732508afb31 80 MotorR_REVERSE=1;
Gsellmann_Sebastian 0:6732508afb31 81 }}
Gsellmann_Sebastian 0:6732508afb31 82
Gsellmann_Sebastian 0:6732508afb31 83 if (TA7==1){ //ggf
Gsellmann_Sebastian 0:6732508afb31 84 MotorL_REVERSE=1;
Gsellmann_Sebastian 0:6732508afb31 85 MotorR_REVERSE=1;
Gsellmann_Sebastian 0:6732508afb31 86 LedD7 = 1;
Gsellmann_Sebastian 0:6732508afb31 87 LedD9 = 1;
Gsellmann_Sebastian 0:6732508afb31 88
Gsellmann_Sebastian 0:6732508afb31 89 }else {
Gsellmann_Sebastian 0:6732508afb31 90 {
Gsellmann_Sebastian 0:6732508afb31 91
Gsellmann_Sebastian 0:6732508afb31 92 LedD7 = 0;
Gsellmann_Sebastian 0:6732508afb31 93 LedD9 = 0;
Gsellmann_Sebastian 0:6732508afb31 94 MotorL_REVERSE=0;
Gsellmann_Sebastian 0:6732508afb31 95 MotorR_REVERSE=0;
Gsellmann_Sebastian 0:6732508afb31 96 MotorR_FORWARD=1;
Gsellmann_Sebastian 0:6732508afb31 97 MotorL_FORWARD=1;
Gsellmann_Sebastian 0:6732508afb31 98 wait(0.5);
Gsellmann_Sebastian 0:6732508afb31 99 MotorR_FORWARD=0;
Gsellmann_Sebastian 0:6732508afb31 100 wait(0.5);
Gsellmann_Sebastian 0:6732508afb31 101 MotorL_FORWARD=0;
Gsellmann_Sebastian 0:6732508afb31 102 MotorL_REVERSE=1;
Gsellmann_Sebastian 0:6732508afb31 103 MotorR_REVERSE=1;
Gsellmann_Sebastian 0:6732508afb31 104 }}
Gsellmann_Sebastian 0:6732508afb31 105
Gsellmann_Sebastian 0:6732508afb31 106 if (TA2==1){ //ggf
Gsellmann_Sebastian 0:6732508afb31 107 MotorL_REVERSE=1;
Gsellmann_Sebastian 0:6732508afb31 108 MotorR_REVERSE=1;
Gsellmann_Sebastian 0:6732508afb31 109 LedD7 = 1;
Gsellmann_Sebastian 0:6732508afb31 110 LedD9 = 1;
Gsellmann_Sebastian 0:6732508afb31 111
Gsellmann_Sebastian 0:6732508afb31 112 }else {
Gsellmann_Sebastian 0:6732508afb31 113 {
Gsellmann_Sebastian 0:6732508afb31 114
Gsellmann_Sebastian 0:6732508afb31 115 LedD7 = 0;
Gsellmann_Sebastian 0:6732508afb31 116 LedD9 = 0;
Gsellmann_Sebastian 0:6732508afb31 117 MotorL_REVERSE=0;
Gsellmann_Sebastian 0:6732508afb31 118 MotorR_REVERSE=0;
Gsellmann_Sebastian 0:6732508afb31 119 MotorR_FORWARD=1;
Gsellmann_Sebastian 0:6732508afb31 120 MotorL_FORWARD=1;
Gsellmann_Sebastian 0:6732508afb31 121 wait(0.5);
Gsellmann_Sebastian 0:6732508afb31 122 MotorR_FORWARD=0;
Gsellmann_Sebastian 0:6732508afb31 123 wait(0.5);
Gsellmann_Sebastian 0:6732508afb31 124 MotorL_FORWARD=0;
Gsellmann_Sebastian 0:6732508afb31 125 MotorL_REVERSE=1;
Gsellmann_Sebastian 0:6732508afb31 126 MotorR_REVERSE=1;
Gsellmann_Sebastian 0:6732508afb31 127 }}
Gsellmann_Sebastian 0:6732508afb31 128
Gsellmann_Sebastian 0:6732508afb31 129
Gsellmann_Sebastian 0:6732508afb31 130 } }