Epileptische Linie Cop. Sophie GmbH
Dependencies: mbed
Fork of Schwarze_Linie1Vorbuebung by
Uebung1.cpp@1:a5392efd321c, 2016-06-15 (annotated)
- 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?
User | Revision | Line number | New 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 | } |