File content as of revision 1:bc5be4e9b077:

#include "mbed.h"
#include "sMotor.h"
 
 
Serial pc(USBTX, USBRX);
sMotor motor(dp13,dp11,dp10,dp9); 
 
int brzina = 1200 ; 
int brojkoraka = 512 ; 
bool p=true;
 
int main() {
 
    
    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);
        }
        }
        
    }
}