Diff: main.cpp

Revision:

1:bc5be4e9b077

Parent:

0:acae693b0964

--- a/main.cpp	Thu May 15 15:13:24 2014 +0000
+++ b/main.cpp	Thu May 15 16:07:29 2014 +0000
@@ -1,12 +1,59 @@
 #include "mbed.h"
-
-DigitalOut myled(LED1);
-
+#include "sMotor.h"
+ 
+ 
+Serial pc(USBTX, USBRX);
+sMotor motor(dp13,dp11,dp10,dp9); 
+ 
+int brzina = 1200 ; 
+int brojkoraka = 512 ; 
+bool p=true;
+ 
 int main() {
-    while(1) {
-        myled = 1;
-        wait(0.2);
-        myled = 0;
-        wait(0.2);
+ 
+    
+    pc.printf("Pocetna brzina: %d\n\r",brzina);
+    pc.printf("1- 360 naprijed\n\r");
+    pc.printf("2- 360 nazad\n\r");
+    pc.printf("3- 180 naprijed\n\r");
+    pc.printf("4- 180 nazad\n\r");
+    pc.printf("5- promijena brzine\n\r");
+    pc.printf("6-stanin\n\r");
+    pc.printf("7-kreni\n\r");
+
+ 
+    while (1) {
+ 
+        if (pc.readable()) { 
+        char z;
+        z=pc.getc();
+ 
+            if (z=='1' )            
+                motor.step(brzina,0,brojkoraka); 
+ 
+            if (z=='2' && p)
+                motor.step(brzina,1,brojkoraka);
+ 
+            if (z=='3' && p)
+                motor.step(brzina/2,0,brojkoraka);
+ 
+            if (z=='4' && p)
+                motor.step(brzina/2,1,brojkoraka);
+ 
+            if (z=='5' && p) {
+                pc.printf("trenutna brzina: %d\n\r", brzina);
+                pc.printf("Nova brzina: \n\r");
+                pc.scanf("%d",&brzina); 
+            }
+            if(z=='6'){
+            p=false;
+            motor.step(0,1,brojkoraka);
+            }
+            if(z=='7'){
+                p=true;
+                motor.step(brzina,1,brojkoraka);
+        }
+        }
+        
     }
-}
+}
\ No newline at end of file