Diff: main.cpp

Revision:

0:7420c8ee25c3

--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/main.cpp	Thu May 15 16:04:40 2014 +0000
@@ -0,0 +1,87 @@
+#include "mbed.h"
+#include "sMotor.h"
+
+
+Serial pc(USBTX, USBRX);
+sMotor motor(dp9, dp10, dp11, dp13); 
+int brzina=800;
+bool on_off=true;
+int smjer=1;
+void meni()
+{
+    pc.printf("A - Postavi osovinu motora (0-360 stepeni) \n\r");
+    pc.printf("S - Promjeni brzinu kretanja \n\r");
+    pc.printf("D - Promjeni smjer kretanja \n\r");
+    pc.printf("F - Pokreni/zaustavi motor \n\r");
+}
+
+void pali_gasi()
+{
+    if(on_off)
+    {
+        motor.step(512,smjer,brzina);
+        pc.printf("Motor je upaljen.\n\r");
+    }
+    else
+    {
+        motor.step(512,smjer,0);
+        pc.printf("Motor je ugasen.\n\r");
+
+    }
+}
+
+void obrnutismjer()
+{
+    motor.step(512,smjer,brzina);
+
+}
+
+int main()
+{
+    char a;
+    while (1)
+    {          
+       
+        meni();
+        a=pc.getc();
+        if(a=='A')
+        {
+            int ugao;
+            pc.printf("\nNavedite ugao pomjeranja motora: \n\r");
+            pc.scanf("%d", &ugao);
+            if ( ugao > 0 )
+                motor.step(512 / 360.0 * (ugao % 360), smjer, brzina);
+            else
+                motor.step(512 / 360.0 * (ugao % 360), 1 - smjer, brzina);
+        }
+        if(a=='S')
+        {
+            pc.printf("\nTrenutna brzina: %d\n\r", brzina);
+            pc.printf("\nNova brzina: \n\r");
+            pc.scanf("%d",&brzina);
+            motor.step(512,smjer,brzina);
+
+        }
+        if(a=='D')
+        {
+            if (smjer==0)
+                smjer=1;
+            else
+                smjer=0;
+           obrnutismjer();
+            pc.printf("\nPromjena smjera. \n\r");
+
+        }
+        
+         if(a=='F')
+        {
+            on_off=!on_off;
+            pali_gasi();
+        }
+       
+
+    }
+
+
+}
+