Diff: main.cpp

Revision:

0:3b0e2caa6ad4

--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/main.cpp	Mon May 12 16:01:59 2014 +0000
@@ -0,0 +1,77 @@
+#include "mbed.h"
+#include "motor.h"
+ 
+Serial pc(USBTX, USBRX);
+motor mt(dp13, dp11, dp10, dp9);
+Ticker tick;
+ 
+int brzina = 1200 ; // set default motor speed
+int brojKoraka = 512 ;
+ 
+void komunikacija() {
+    char c = pc.getc();
+    while (c != '0' && c != '1' && c != '2' && c != '3' && c != '4' &&  c!='5') 
+        c = pc.getc();
+        pc.printf("Char %c\n", c);
+    if (c=='1')
+        mt.korak(brojKoraka,0,brzina); // number of steps, direction, speed
+ 
+    if (c=='2')
+        mt.korak(brojKoraka,1,brzina);
+ 
+    if (c=='3')
+        mt.korak(brojKoraka/2,0,brzina);
+ 
+    if (c=='4')
+        mt.korak(brojKoraka/2,1,brzina);
+ 
+    if (c=='5') {
+        pc.printf("Current Speed: %d\n\r", brzina);
+        pc.printf("New speed: \n\r");
+        pc.scanf("%d",&brzina); // sets new speed
+        }
+}
+ 
+int main() {
+    // Screen Menu
+    pc.printf("Osnovna brzina: %d\n\r",brzina);
+    pc.printf("1- 360 stepeni naprijed\n\r");
+    pc.printf("2- 360 stepeni nazad\n\r");
+    pc.printf("3- 180 stepeni naprijed\n\r");
+    pc.printf("4- 180 stepeni nazad\n\r");
+    pc.printf("5- Promijeni brzinu\n\r");
+    //pc.attach(&komunikacija);
+    
+    while(1) {
+        char c = pc.getc();
+    //while (c != 'a' && c != 'b' && c != 'c' && c != 'd' && c != 'e' &&  c!='f') 
+        //c = pc.getc();
+        //pc.printf("Char %c\n", c);
+    if (c=='a')
+        mt.korak(brojKoraka,0,brzina); // number of steps, direction, speed
+ 
+    if (c=='b')
+        mt.korak(brojKoraka,1,brzina);
+ 
+    if (c=='d')
+        mt.korak(brojKoraka/2,0,brzina);
+ 
+    if (c=='e')
+        mt.korak(brojKoraka/2,1,brzina);
+ 
+    if (c=='f') {
+        pc.printf("Current Speed: %d\n\r", brzina);
+        pc.printf("New speed: \n\r");        
+        pc.scanf("%d",&brzina); // sets new speed
+        }
+    if (c=='g') {
+        pc.printf("\nStepeni: ");
+        float stepeni(0);
+        pc.scanf("%f", &stepeni);
+        float temp(stepeni/5.625);
+        mt.korak(brojKoraka/(64/temp),0,brzina);
+        }
+        }
+   
+ 
+}
\ No newline at end of file