Arnela Duzan Sabina Grosic

Dependencies:   mbed sMotor

main.cpp

Committer:
tim007
Date:
2014-05-15
Revision:
0:31a6dc612e55

File content as of revision 0:31a6dc612e55:

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

Serial pc(USBTX, USBRX);
sMotor motor(dp9, dp10, dp11, dp13); 
int brzina_koraka = 1200;
int broj_koraka=512;
bool on = false; 
int smjer=1;  
float ugao; 


int main() {
    
       pc.printf("a- postavi polozaj\n\r"); 
       pc.printf("b- promjena smjera\n\r"); 
       pc.printf("c-promjena brzine\n\r"); 
       pc.printf("d-pokretanje/zaustavljanje\n\r");
       while(1) {
       
     
       
       
       if(on==false) 
       motor.step(broj_koraka, smjer, brzina_koraka); 
       
       
       if(pc.getc() == 'a')
       {
            pc.printf("Unesi ugao pomjeranja motora:\n"); 
            pc.scanf("%.2f", &ugao); 
            if(ugao<0)
            motor.step((ugao*broj_koraka)/360, 1-smjer, brzina_koraka); 
            else if(ugao>0)
            motor.step((ugao*broj_koraka)/360, smjer, brzina_koraka);         
        }
        else if(pc.getc() == 'b')
        {
            
            if(smjer==1) 
            smjer=0; 
            else if(smjer==0)
            smjer=1; 
        }
        else if(pc.getc() == 'c')
        {
            pc.printf("Unesi brzinu:\n");
            pc.scanf("%d", &brzina_koraka); 
            motor.step(broj_koraka,smjer, brzina_koraka); 
            
        }
       else if(pc.getc() == 'd')
        {
            if(!on) 
            on=false; 
            else 
            on=true; 
        }
            
       
       
       
       
    }
}