tim007 tim007
/
pai_grupa7_tim007_lv9_z2
Arnela Duzan Sabina Grosic
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; } } }