Diff: main.cpp

Revision:

0:07dda97b5a79

--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/main.cpp	Mon Nov 16 14:38:39 2015 +0000
@@ -0,0 +1,49 @@
+#include "mbed.h"
+#include "const.h"
+#include "Robot.h"
+
+Robot bertl;
+    
+int main()
+{
+
+    
+    while(1)
+    {
+        bertl.TurnLedOn(LED_FL1);
+        bertl.TurnLedOn(LED_FL2);
+        wait_ms(500);
+        bertl.TurnLedOff(LED_FL1);
+        bertl.TurnLedOff(LED_FL2);
+        
+        bert.NibbleLeds(0x0F);
+        
+        
+        bertl.TurnLedOn(LED_FR1);
+        bertl.TurnLedOn(LED_FR2);
+        wait_ms(500);
+        bertl.TurnLedOff(LED_FR1);
+        bertl.TurnLedOff(LED_FR2);
+        
+        bertl.RGBLed(1,0,0);
+        wait_ms(500);
+        bertl.RGBLed(0,1,0);
+        wait_ms(500);
+        bertl.RGBLed(0,0,1);
+        wait_ms(500);
+        bertl.RGBLed(0,0,0);
+        
+        bertl.TurnLedOn(LED_BR1);
+        bertl.TurnLedOn(LED_BR2);
+        wait_ms(500);
+        bertl.TurnLedOff(LED_BR1);
+        bertl.TurnLedOff(LED_BR2);
+        
+        bertl.TurnLedOn(LED_BL1);
+        bertl.TurnLedOn(LED_BL2);
+        wait_ms(500);
+        bertl.TurnLedOff(LED_BL1);
+        bertl.TurnLedOff(LED_BL2);
+        
+    }
+}
\ No newline at end of file