If_Task1

Dependencies:   mbed

Committer:
Pouter123
Date:
Thu Apr 16 12:51:12 2015 +0000
Revision:
0:cd8d2f27aae1
If_Task1

Who changed what in which revision?

UserRevisionLine numberNew contents of line
Pouter123 0:cd8d2f27aae1 1 #include "mbed.h"
Pouter123 0:cd8d2f27aae1 2 #include "ur_Bertl.h"
Pouter123 0:cd8d2f27aae1 3 #include "const.h"
Pouter123 0:cd8d2f27aae1 4 #include "Bertl_Ifnew.h"
Pouter123 0:cd8d2f27aae1 5
Pouter123 0:cd8d2f27aae1 6 bool Bertl_Ifnew :: LeftIsBlocked()
Pouter123 0:cd8d2f27aae1 7 {
Pouter123 0:cd8d2f27aae1 8 bool blocked;
Pouter123 0:cd8d2f27aae1 9 TurnLeft();
Pouter123 0:cd8d2f27aae1 10 blocked = !FrontIsClear();
Pouter123 0:cd8d2f27aae1 11 TurnLeft();
Pouter123 0:cd8d2f27aae1 12 TurnLeft();
Pouter123 0:cd8d2f27aae1 13 TurnLeft();
Pouter123 0:cd8d2f27aae1 14
Pouter123 0:cd8d2f27aae1 15 return blocked;
Pouter123 0:cd8d2f27aae1 16 }
Pouter123 0:cd8d2f27aae1 17
Pouter123 0:cd8d2f27aae1 18
Pouter123 0:cd8d2f27aae1 19 bool Bertl_Ifnew :: FrontIsClear_AND_BTN_FLL_NotPressed()
Pouter123 0:cd8d2f27aae1 20 {
Pouter123 0:cd8d2f27aae1 21 if(FrontIsClear() && !IsButtonPressed(BTN_FLL))
Pouter123 0:cd8d2f27aae1 22 return true;
Pouter123 0:cd8d2f27aae1 23
Pouter123 0:cd8d2f27aae1 24 else
Pouter123 0:cd8d2f27aae1 25 return false;
Pouter123 0:cd8d2f27aae1 26 }
Pouter123 0:cd8d2f27aae1 27
Pouter123 0:cd8d2f27aae1 28 bool Bertl_Ifnew :: FrontIsClear_OR_BTN_FLL_Pressed()
Pouter123 0:cd8d2f27aae1 29 {
Pouter123 0:cd8d2f27aae1 30 if(FrontIsClear() || IsButtonPressed(BTN_FLL))
Pouter123 0:cd8d2f27aae1 31 return true;
Pouter123 0:cd8d2f27aae1 32
Pouter123 0:cd8d2f27aae1 33 else
Pouter123 0:cd8d2f27aae1 34 return false;
Pouter123 0:cd8d2f27aae1 35 }