Diff: main.cpp

Revision:

0:0d6f0416f18e

--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/main.cpp	Mon Dec 21 14:37:34 2015 +0000
@@ -0,0 +1,57 @@
+#include "mbed.h"
+#include "Robot.h"
+#include "ur_Bertl.h"
+
+Robot bertl;
+
+void Bewegen()
+{
+   bertl.Move();  
+}
+
+void DrehNachRechts() 
+{
+        bertl.TurnRigth();
+}     
+    
+void DrehNachLinks()
+{
+    bertl.TurnLeft();     
+}
+
+void BlinkenRechts()
+{
+    if(bertl.frontIsClear())
+    {
+     bertl.TurnLedOn(LED_FR2); 
+     bertl.TurnLedOn(LED_BR1);
+     
+     wait(0.1);
+  
+     bertl.TurnLedOff(LED_FR2);
+     bertl.TurnLedOff(LED_BR1);  
+    }
+    
+    
+}
+
+void BlinkenLinks()
+{
+ if(bertl.frontIsClear())
+ {
+     bertl.TurnLedOn(LED_FL2);
+     bertl.TurnLedOn(LED_BL1);
+     
+     wait(0.1);
+  
+     bertl.TurnLedOff(LED_FL2);
+     bertl.TurnLedOff(LED_BL1);   
+  }   
+
+}
+
+
+void main()
+{
+
+}