Funktionen

Dependencies:   Bertl mbed

main.cpp

Committer:
Phil_1409
Date:
2015-12-21
Revision:
0:b2556c73a145

File content as of revision 0:b2556c73a145:

#include "mbed.h"
#include "Robot.h"
#include "ur_Bertl.h"

Robot bertl;

void TurnRight()
{
    bertl.TurnRigth();
}

void TurnLeft()
{
    bertl.TurnLeft();
}

void Move()
{
    bertl.Move();
}

void MoveBack()
{
    bertl.MoveBackwards();
}

bool FrontIsClear()
{
    if(bertl.frontIsClear())
        return true;
    else
        return false;
}

void AllFrontLedOn()
{
    bertl.TurnLedOn(LED_ALL_FRONT);
}

void AllFrontLedOff()
{
    bertl.TurnLedOff(LED_ALL_FRONT);
}

void AllBackLedOn()
{
    bertl.TurnLedOn(LED_ALL_BACK);
}

void AllBackLedOff()
{
    bertl.TurnLedOff(LED_ALL_BACK);
}

void AllLedOn()
{
    bertl.TurnLedOn(LED_ALL);
}

void AllLedOff()
{
    bertl.TurnLedOff(LED_ALL);
}

void AlertLights()
{
    for(int x=0; x<3; x++)
    {
        bertl.TurnLedOn(LED_FL2);
        bertl.TurnLedOn(LED_FR2);
        bertl.TurnLedOn(LED_BL1);
        bertl.TurnLedOn(LED_BR1);
        wait(0.1);
        bertl.TurnLedOff(LED_FL2);
        bertl.TurnLedOff(LED_FR2);
        bertl.TurnLedOff(LED_BL1);
        bertl.TurnLedOff(LED_BR2);
    }
}

void BlinkLeft()
{
    for(int x=0; x<3; x++)
    {
        bertl.TurnLedOn(LED_FL2);
        bertl.TurnLedOn(LED_BL1);
        wait(0.1);
        bertl.TurnLedOff(LED_FL2);
        bertl.TurnLedOff(LED_BL1);
    }
}

void BlinkRight()
{
    for(int x=0; x<3; x++)
    {
        bertl.TurnLedOn(LED_FR2);
        bertl.TurnLedOn(LED_BR2);
        wait(0.1);
        bertl.TurnLedOff(LED_FR2);
        bertl.TurnLedOff(LED_BR2);
    }
}

int main()
{
    while(1)
    {
        
    }    
}