Epileptische Linie Cop. Sophie GmbH

Dependencies:   mbed

Fork of Schwarze_Linie1Vorbuebung by Bulme_BHEL2016-[Rest]

Committer:
SophieRechar
Date:
Wed Jun 15 07:16:59 2016 +0000
Revision:
1:a5392efd321c
Parent:
0:b4f9731c4fad
Epileptische Linie Cop. Sophie GMbH

Who changed what in which revision?

UserRevisionLine numberNew contents of line
marcusrus 0:b4f9731c4fad 1 #include "mbed.h"
marcusrus 0:b4f9731c4fad 2
marcusrus 0:b4f9731c4fad 3 DigitalOut Von (P2_13); // 12 V ON
marcusrus 0:b4f9731c4fad 4 DigitalOut LineON (P2_5); // Line Sensor aktivieren
marcusrus 0:b4f9731c4fad 5 DigitalIn ISO1 (P1_9); // ISO1
marcusrus 0:b4f9731c4fad 6 DigitalIn ISO2 (P0_16);
marcusrus 0:b4f9731c4fad 7 DigitalIn ISO3 (P0_23);
marcusrus 0:b4f9731c4fad 8 DigitalIn ISO4 (P0_15);
SophieRechar 1:a5392efd321c 9 DigitalIn ISO5 (P1_3);
marcusrus 0:b4f9731c4fad 10
marcusrus 0:b4f9731c4fad 11 DigitalOut LedD1 (P1_10);
marcusrus 0:b4f9731c4fad 12 DigitalOut LedD2 (P1_11);
marcusrus 0:b4f9731c4fad 13 DigitalOut LedD4 (P1_12);
marcusrus 0:b4f9731c4fad 14 DigitalOut LedD5 (P1_13);
marcusrus 0:b4f9731c4fad 15 DigitalOut LedD6 (P1_14);
marcusrus 0:b4f9731c4fad 16 DigitalOut LedD7 (P1_15);
marcusrus 0:b4f9731c4fad 17 DigitalOut LedD8 (P1_16);
marcusrus 0:b4f9731c4fad 18 DigitalOut LedD9 (P1_17);
marcusrus 0:b4f9731c4fad 19 DigitalOut LedD10 (P1_18);
marcusrus 0:b4f9731c4fad 20 DigitalOut LedD11 (P2_16);
marcusrus 0:b4f9731c4fad 21 DigitalOut LedD12 (P1_20);
marcusrus 0:b4f9731c4fad 22 DigitalOut LedD13 (P1_21);
marcusrus 0:b4f9731c4fad 23
SophieRechar 1:a5392efd321c 24 PwmOut MotorL_EN(P1_19);
SophieRechar 1:a5392efd321c 25 DigitalOut MotorL_FORWARD(P2_15);
SophieRechar 1:a5392efd321c 26 DigitalOut MotorL_REVERSE(P2_14);
marcusrus 0:b4f9731c4fad 27
SophieRechar 1:a5392efd321c 28 PwmOut MotorR_EN(P2_19);
SophieRechar 1:a5392efd321c 29 DigitalOut MotorR_FORWARD(P2_20);
SophieRechar 1:a5392efd321c 30 DigitalOut MotorR_REVERSE(P2_21);
marcusrus 0:b4f9731c4fad 31
marcusrus 0:b4f9731c4fad 32 int main()
marcusrus 0:b4f9731c4fad 33 {
SophieRechar 1:a5392efd321c 34 MotorL_EN.period_ms(10.0f);
SophieRechar 1:a5392efd321c 35 MotorR_EN.period_ms(10.0f);
SophieRechar 1:a5392efd321c 36
marcusrus 0:b4f9731c4fad 37 do
marcusrus 0:b4f9731c4fad 38 {
SophieRechar 1:a5392efd321c 39 MotorR_EN = MotorL_EN = 0.3;
SophieRechar 1:a5392efd321c 40 LineON = 1;
SophieRechar 1:a5392efd321c 41 Von = 1;
marcusrus 0:b4f9731c4fad 42
SophieRechar 1:a5392efd321c 43 MotorR_FORWARD = MotorL_FORWARD = 1;
SophieRechar 1:a5392efd321c 44
SophieRechar 1:a5392efd321c 45 if(ISO1 == 0)
SophieRechar 1:a5392efd321c 46 {
SophieRechar 1:a5392efd321c 47 MotorR_FORWARD = MotorL_FORWARD = 0;
SophieRechar 1:a5392efd321c 48 MotorL_EN = 0.7;
SophieRechar 1:a5392efd321c 49 MotorL_FORWARD = 1;
SophieRechar 1:a5392efd321c 50 MotorR_FORWARD = 0;
SophieRechar 1:a5392efd321c 51 }
SophieRechar 1:a5392efd321c 52
SophieRechar 1:a5392efd321c 53 else if(ISO4 == 0)
SophieRechar 1:a5392efd321c 54 {
SophieRechar 1:a5392efd321c 55 MotorR_FORWARD = MotorL_FORWARD = 0;
SophieRechar 1:a5392efd321c 56 MotorL_EN = 0.7;
SophieRechar 1:a5392efd321c 57 MotorL_FORWARD = 0;
SophieRechar 1:a5392efd321c 58 MotorR_FORWARD = 1;
SophieRechar 1:a5392efd321c 59 }
SophieRechar 1:a5392efd321c 60
SophieRechar 1:a5392efd321c 61 else if(ISO5 == 0)
SophieRechar 1:a5392efd321c 62 {
SophieRechar 1:a5392efd321c 63 MotorR_FORWARD = MotorL_FORWARD = 0;
SophieRechar 1:a5392efd321c 64 MotorR_FORWARD = MotorL_FORWARD = 0.3;
SophieRechar 1:a5392efd321c 65 }
SophieRechar 1:a5392efd321c 66 }while(1);
marcusrus 0:b4f9731c4fad 67 }