Georg Jonak / Mbed 2 deprecated Bertl_Taster

dreht bei berührung

Dependencies:   mbed

main.cpp@0:91e9dc4737ca, 2016-06-06 (annotated)

Committer:
georgjonak
Date:
Mon Jun 06 11:43:54 2016 +0000
Revision:
0:91e9dc4737ca
Dreht um bei ber?hrung;

Who changed what in which revision?

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