File content as of revision 0:3b0e2caa6ad4:

#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);
        }
        }
   
 
}