If_Task1

Dependencies:   mbed

Bertl_Ifnew.cpp

Committer:
Pouter123
Date:
2015-04-16
Revision:
0:cd8d2f27aae1

File content as of revision 0:cd8d2f27aae1:

#include "mbed.h"
#include "ur_Bertl.h"
#include "const.h"
#include "Bertl_Ifnew.h"

bool Bertl_Ifnew :: LeftIsBlocked()
{
    bool blocked;
    TurnLeft();
    blocked = !FrontIsClear();
    TurnLeft();
    TurnLeft();
    TurnLeft();
    
    return blocked;
}


bool Bertl_Ifnew :: FrontIsClear_AND_BTN_FLL_NotPressed()
{
    if(FrontIsClear() && !IsButtonPressed(BTN_FLL))
        return true;
        
    else
        return false;
}

bool Bertl_Ifnew :: FrontIsClear_OR_BTN_FLL_Pressed()
{
     if(FrontIsClear() || IsButtonPressed(BTN_FLL))
        return true;
        
    else
        return false;
}