Diff: main.cpp

Revision:

0:dd7edc75e697

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