main.cpp

00001 #include "mbed.h"
00002 #include "const.h"
00003 #include "Robot.h"
00004 
00005 Robot bertl;
00006     
00007 int main()
00008 {
00009 
00010     
00011     while(1)
00012     {
00013         bertl.TurnLedOn(LED_FL1);
00014         bertl.TurnLedOn(LED_FL2);
00015         wait_ms(500);
00016         bertl.TurnLedOff(LED_FL1);
00017         bertl.TurnLedOff(LED_FL2);
00018         
00019         bert.NibbleLeds(0x0F);
00020         
00021         
00022         bertl.TurnLedOn(LED_FR1);
00023         bertl.TurnLedOn(LED_FR2);
00024         wait_ms(500);
00025         bertl.TurnLedOff(LED_FR1);
00026         bertl.TurnLedOff(LED_FR2);
00027         
00028         bertl.RGBLed(1,0,0);
00029         wait_ms(500);
00030         bertl.RGBLed(0,1,0);
00031         wait_ms(500);
00032         bertl.RGBLed(0,0,1);
00033         wait_ms(500);
00034         bertl.RGBLed(0,0,0);
00035         
00036         bertl.TurnLedOn(LED_BR1);
00037         bertl.TurnLedOn(LED_BR2);
00038         wait_ms(500);
00039         bertl.TurnLedOff(LED_BR1);
00040         bertl.TurnLedOff(LED_BR2);
00041         
00042         bertl.TurnLedOn(LED_BL1);
00043         bertl.TurnLedOn(LED_BL2);
00044         wait_ms(500);
00045         bertl.TurnLedOff(LED_BL1);
00046         bertl.TurnLedOff(LED_BL2);
00047         
00048     }
00049 }