Czosnekengine

Dependencies:   mbed

Revision:
0:a0c8b50a7292
--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/main.cpp	Wed May 18 12:08:19 2016 +0000
@@ -0,0 +1,36 @@
+#include "Engine.h"
+
+Serial pc(SERIAL_TX, SERIAL_RX);
+int liczba =0;
+int main() {
+    //inicjalizacja silnikow - piny dzialaja:
+    Engine eng_left = Engine(PB_13, PB_4, PB_10);
+    Engine eng_right = Engine(PB_14, PB_5, PB_3);
+    
+    
+    while(true) {
+        // testy - przyspiesz od 0 do 100% a potem zwolnij:
+            eng_left.move(0);
+            eng_right.move(0);
+            wait(1);
+            srand( time( NULL ) );
+            liczba = (std::rand() % 200 ) - 100;
+            eng_left.move(liczba);
+            eng_right.move(liczba);
+            wait(5);
+            if (liczba==0){
+                pc.printf("%f", time(NULL));
+                pc.printf("Nie ma wiatru, wiec stoje w miejscu.");
+                }
+            else if (liczba>0){
+                pc.printf("%f", time(NULL));
+                pc.printf("Jade do przodu. Predkosc w procentach to %d \n", liczba);
+                }
+            else {
+                pc.printf("%f", time(NULL));
+                pc.printf("Jade do tylu. Predkosc w procentach to %d \n", liczba);
+                }
+        
+    }
+
+}
\ No newline at end of file