Diff: main.cpp

Revision:

0:4fd50fc0dbd7

--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/main.cpp	Mon May 12 15:59:56 2014 +0000
@@ -0,0 +1,64 @@
+#include "mbed.h"
+#include "sMotor.h"
+ 
+ 
+Serial pc(USBTX, USBRX);
+sMotor motor(dp9, dp10, dp11, dp13); // creates new stepper motor: IN1, IN2, IN3, IN4
+ 
+int step_speed = 1200 ; // set default motor speed
+int numstep = 512 ; // defines full turn of 360 degree
+int direction = 0;
+bool on=true;
+//you might want to calibrate this value according to your motor
+ 
+ 
+int main() {
+    l1:
+    pc.printf("1- Izbor polozaja motora\n\r");
+    pc.printf("2- Izbor smjera kretanja motora\n\r");
+    pc.printf("3- Promjena brzine kretanja motora\n\r");
+    pc.printf("4- Pokretanje/zaustavljanje motora\n\r");
+    
+    while (1) {
+        if (pc.readable()) { // checks for serial
+        
+            if (pc.getc()=='1'){
+                if(on)
+                {
+                int angle;
+                pc.printf("Navedite ugao pomjeranja motora: \n\r");
+                pc.scanf("%d", &angle);
+                if ( angle > 0 )
+                motor.step(numstep / 360 * (angle % 360), direction, step_speed); 
+                else
+                motor.step(numstep / 360 * (angle % 360), 1 - direction, step_speed); 
+                }
+                else
+                pc.printf("Motor je zaustavljen. \n\r");
+                goto l1;
+                }else
+            if (pc.getc()=='2'){
+                pc.printf("\n Doslo je do promjene smjera. \n\r");
+                direction=1-direction;
+                goto l1;
+                }else
+            if (pc.getc()=='3'){
+                pc.printf("Trenutna brzina: %d\n\r", step_speed);
+                pc.printf("Nova brzina: \n\r");
+                pc.scanf("%d",&step_speed);
+                goto l1;
+                }else
+            if (pc.getc()=='4'){
+                on=!on;
+                if(on){
+                pc.printf("Motor je pokrenut.\n\r");
+                
+                }
+                else{
+                pc.printf("Motor je zaustavljen. \n\r");}
+                goto l1;
+              }
+              else goto l1;
+        }
+    }
+}
\ No newline at end of file