Funktionen

Dependencies:   Bertl mbed

Committer:
Phil_1409
Date:
Mon Dec 21 14:37:10 2015 +0000
Revision:
0:b2556c73a145
Funktionen

Who changed what in which revision?

UserRevisionLine numberNew 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 }