File content as of revision 0:7420c8ee25c3:

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

    }


}