Beganovic Benjamin Babic Mirhat

Dependencies:   mbed sMotor

main.cpp

Committer:
tim010
Date:
2014-05-12
Revision:
0:05d9a754fd34

File content as of revision 0:05d9a754fd34:

#include "mbed.h"
#include "sMotor.h"

Serial pc(USBTX, USBRX);
sMotor motor(dp9, dp10, dp11, dp13);
Ticker flipper;



int brzina = 1200;
int smjer = 0;
bool upaljen = false;
int pomak = 1;

void okreci()
{
    if(upaljen) motor.step(0.3, smjer, brzina);
}

int main() {
    
    char izbor;
    flipper.attach(&okreci, 1);
    while(1)
    {
        pc.printf("Unesite broj od 1 do 4\n");
        izbor = pc.getc();
        if(izbor == '1'){
            pc.printf("Unesite stepene od 0 do 360");
            pc.scanf("%d", &pomak);
            int brojKoraka = (int)pomak;
            motor.step(brojKoraka, smjer, brzina);
        }
        else if(izbor == '2'){
            smjer = (smjer + 1) % 2;
        }
        else if(izbor == '3'){
            pc.printf("Unesite novu brzinu");
            pc.scanf("%d", &brzina); 
              
        }
        else if(izbor == '4'){
            
            if(upaljen == false) upaljen = true;
            else upaljen = false;
        }
        
    }
}