Philipp Maier
/
BERTL_Crash
Funktionen
main.cpp@0:b2556c73a145, 2015-12-21 (annotated)
- Committer:
- Phil_1409
- Date:
- Mon Dec 21 14:37:10 2015 +0000
- Revision:
- 0:b2556c73a145
Funktionen
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
Phil_1409 | 0:b2556c73a145 | 1 | #include "mbed.h" |
Phil_1409 | 0:b2556c73a145 | 2 | #include "Robot.h" |
Phil_1409 | 0:b2556c73a145 | 3 | #include "ur_Bertl.h" |
Phil_1409 | 0:b2556c73a145 | 4 | |
Phil_1409 | 0:b2556c73a145 | 5 | Robot bertl; |
Phil_1409 | 0:b2556c73a145 | 6 | |
Phil_1409 | 0:b2556c73a145 | 7 | void TurnRight() |
Phil_1409 | 0:b2556c73a145 | 8 | { |
Phil_1409 | 0:b2556c73a145 | 9 | bertl.TurnRigth(); |
Phil_1409 | 0:b2556c73a145 | 10 | } |
Phil_1409 | 0:b2556c73a145 | 11 | |
Phil_1409 | 0:b2556c73a145 | 12 | void TurnLeft() |
Phil_1409 | 0:b2556c73a145 | 13 | { |
Phil_1409 | 0:b2556c73a145 | 14 | bertl.TurnLeft(); |
Phil_1409 | 0:b2556c73a145 | 15 | } |
Phil_1409 | 0:b2556c73a145 | 16 | |
Phil_1409 | 0:b2556c73a145 | 17 | void Move() |
Phil_1409 | 0:b2556c73a145 | 18 | { |
Phil_1409 | 0:b2556c73a145 | 19 | bertl.Move(); |
Phil_1409 | 0:b2556c73a145 | 20 | } |
Phil_1409 | 0:b2556c73a145 | 21 | |
Phil_1409 | 0:b2556c73a145 | 22 | void MoveBack() |
Phil_1409 | 0:b2556c73a145 | 23 | { |
Phil_1409 | 0:b2556c73a145 | 24 | bertl.MoveBackwards(); |
Phil_1409 | 0:b2556c73a145 | 25 | } |
Phil_1409 | 0:b2556c73a145 | 26 | |
Phil_1409 | 0:b2556c73a145 | 27 | bool FrontIsClear() |
Phil_1409 | 0:b2556c73a145 | 28 | { |
Phil_1409 | 0:b2556c73a145 | 29 | if(bertl.frontIsClear()) |
Phil_1409 | 0:b2556c73a145 | 30 | return true; |
Phil_1409 | 0:b2556c73a145 | 31 | else |
Phil_1409 | 0:b2556c73a145 | 32 | return false; |
Phil_1409 | 0:b2556c73a145 | 33 | } |
Phil_1409 | 0:b2556c73a145 | 34 | |
Phil_1409 | 0:b2556c73a145 | 35 | void AllFrontLedOn() |
Phil_1409 | 0:b2556c73a145 | 36 | { |
Phil_1409 | 0:b2556c73a145 | 37 | bertl.TurnLedOn(LED_ALL_FRONT); |
Phil_1409 | 0:b2556c73a145 | 38 | } |
Phil_1409 | 0:b2556c73a145 | 39 | |
Phil_1409 | 0:b2556c73a145 | 40 | void AllFrontLedOff() |
Phil_1409 | 0:b2556c73a145 | 41 | { |
Phil_1409 | 0:b2556c73a145 | 42 | bertl.TurnLedOff(LED_ALL_FRONT); |
Phil_1409 | 0:b2556c73a145 | 43 | } |
Phil_1409 | 0:b2556c73a145 | 44 | |
Phil_1409 | 0:b2556c73a145 | 45 | void AllBackLedOn() |
Phil_1409 | 0:b2556c73a145 | 46 | { |
Phil_1409 | 0:b2556c73a145 | 47 | bertl.TurnLedOn(LED_ALL_BACK); |
Phil_1409 | 0:b2556c73a145 | 48 | } |
Phil_1409 | 0:b2556c73a145 | 49 | |
Phil_1409 | 0:b2556c73a145 | 50 | void AllBackLedOff() |
Phil_1409 | 0:b2556c73a145 | 51 | { |
Phil_1409 | 0:b2556c73a145 | 52 | bertl.TurnLedOff(LED_ALL_BACK); |
Phil_1409 | 0:b2556c73a145 | 53 | } |
Phil_1409 | 0:b2556c73a145 | 54 | |
Phil_1409 | 0:b2556c73a145 | 55 | void AllLedOn() |
Phil_1409 | 0:b2556c73a145 | 56 | { |
Phil_1409 | 0:b2556c73a145 | 57 | bertl.TurnLedOn(LED_ALL); |
Phil_1409 | 0:b2556c73a145 | 58 | } |
Phil_1409 | 0:b2556c73a145 | 59 | |
Phil_1409 | 0:b2556c73a145 | 60 | void AllLedOff() |
Phil_1409 | 0:b2556c73a145 | 61 | { |
Phil_1409 | 0:b2556c73a145 | 62 | bertl.TurnLedOff(LED_ALL); |
Phil_1409 | 0:b2556c73a145 | 63 | } |
Phil_1409 | 0:b2556c73a145 | 64 | |
Phil_1409 | 0:b2556c73a145 | 65 | void AlertLights() |
Phil_1409 | 0:b2556c73a145 | 66 | { |
Phil_1409 | 0:b2556c73a145 | 67 | for(int x=0; x<3; x++) |
Phil_1409 | 0:b2556c73a145 | 68 | { |
Phil_1409 | 0:b2556c73a145 | 69 | bertl.TurnLedOn(LED_FL2); |
Phil_1409 | 0:b2556c73a145 | 70 | bertl.TurnLedOn(LED_FR2); |
Phil_1409 | 0:b2556c73a145 | 71 | bertl.TurnLedOn(LED_BL1); |
Phil_1409 | 0:b2556c73a145 | 72 | bertl.TurnLedOn(LED_BR1); |
Phil_1409 | 0:b2556c73a145 | 73 | wait(0.1); |
Phil_1409 | 0:b2556c73a145 | 74 | bertl.TurnLedOff(LED_FL2); |
Phil_1409 | 0:b2556c73a145 | 75 | bertl.TurnLedOff(LED_FR2); |
Phil_1409 | 0:b2556c73a145 | 76 | bertl.TurnLedOff(LED_BL1); |
Phil_1409 | 0:b2556c73a145 | 77 | bertl.TurnLedOff(LED_BR2); |
Phil_1409 | 0:b2556c73a145 | 78 | } |
Phil_1409 | 0:b2556c73a145 | 79 | } |
Phil_1409 | 0:b2556c73a145 | 80 | |
Phil_1409 | 0:b2556c73a145 | 81 | void BlinkLeft() |
Phil_1409 | 0:b2556c73a145 | 82 | { |
Phil_1409 | 0:b2556c73a145 | 83 | for(int x=0; x<3; x++) |
Phil_1409 | 0:b2556c73a145 | 84 | { |
Phil_1409 | 0:b2556c73a145 | 85 | bertl.TurnLedOn(LED_FL2); |
Phil_1409 | 0:b2556c73a145 | 86 | bertl.TurnLedOn(LED_BL1); |
Phil_1409 | 0:b2556c73a145 | 87 | wait(0.1); |
Phil_1409 | 0:b2556c73a145 | 88 | bertl.TurnLedOff(LED_FL2); |
Phil_1409 | 0:b2556c73a145 | 89 | bertl.TurnLedOff(LED_BL1); |
Phil_1409 | 0:b2556c73a145 | 90 | } |
Phil_1409 | 0:b2556c73a145 | 91 | } |
Phil_1409 | 0:b2556c73a145 | 92 | |
Phil_1409 | 0:b2556c73a145 | 93 | void BlinkRight() |
Phil_1409 | 0:b2556c73a145 | 94 | { |
Phil_1409 | 0:b2556c73a145 | 95 | for(int x=0; x<3; x++) |
Phil_1409 | 0:b2556c73a145 | 96 | { |
Phil_1409 | 0:b2556c73a145 | 97 | bertl.TurnLedOn(LED_FR2); |
Phil_1409 | 0:b2556c73a145 | 98 | bertl.TurnLedOn(LED_BR2); |
Phil_1409 | 0:b2556c73a145 | 99 | wait(0.1); |
Phil_1409 | 0:b2556c73a145 | 100 | bertl.TurnLedOff(LED_FR2); |
Phil_1409 | 0:b2556c73a145 | 101 | bertl.TurnLedOff(LED_BR2); |
Phil_1409 | 0:b2556c73a145 | 102 | } |
Phil_1409 | 0:b2556c73a145 | 103 | } |
Phil_1409 | 0:b2556c73a145 | 104 | |
Phil_1409 | 0:b2556c73a145 | 105 | int main() |
Phil_1409 | 0:b2556c73a145 | 106 | { |
Phil_1409 | 0:b2556c73a145 | 107 | while(1) |
Phil_1409 | 0:b2556c73a145 | 108 | { |
Phil_1409 | 0:b2556c73a145 | 109 | |
Phil_1409 | 0:b2556c73a145 | 110 | } |
Phil_1409 | 0:b2556c73a145 | 111 | } |