Beganovic Benjamin Babic Mirhat

Dependencies:   mbed sMotor

Committer:
tim010
Date:
Mon May 12 10:04:03 2014 +0000
Revision:
0:05d9a754fd34
LV9-GRUPA2-TIM010-ZADATAK2

Who changed what in which revision?

UserRevisionLine numberNew contents of line
tim010 0:05d9a754fd34 1 #include "mbed.h"
tim010 0:05d9a754fd34 2 #include "sMotor.h"
tim010 0:05d9a754fd34 3
tim010 0:05d9a754fd34 4 Serial pc(USBTX, USBRX);
tim010 0:05d9a754fd34 5 sMotor motor(dp9, dp10, dp11, dp13);
tim010 0:05d9a754fd34 6 Ticker flipper;
tim010 0:05d9a754fd34 7
tim010 0:05d9a754fd34 8
tim010 0:05d9a754fd34 9
tim010 0:05d9a754fd34 10 int brzina = 1200;
tim010 0:05d9a754fd34 11 int smjer = 0;
tim010 0:05d9a754fd34 12 bool upaljen = false;
tim010 0:05d9a754fd34 13 int pomak = 1;
tim010 0:05d9a754fd34 14
tim010 0:05d9a754fd34 15 void okreci()
tim010 0:05d9a754fd34 16 {
tim010 0:05d9a754fd34 17 if(upaljen) motor.step(0.3, smjer, brzina);
tim010 0:05d9a754fd34 18 }
tim010 0:05d9a754fd34 19
tim010 0:05d9a754fd34 20 int main() {
tim010 0:05d9a754fd34 21
tim010 0:05d9a754fd34 22 char izbor;
tim010 0:05d9a754fd34 23 flipper.attach(&okreci, 1);
tim010 0:05d9a754fd34 24 while(1)
tim010 0:05d9a754fd34 25 {
tim010 0:05d9a754fd34 26 pc.printf("Unesite broj od 1 do 4\n");
tim010 0:05d9a754fd34 27 izbor = pc.getc();
tim010 0:05d9a754fd34 28 if(izbor == '1'){
tim010 0:05d9a754fd34 29 pc.printf("Unesite stepene od 0 do 360");
tim010 0:05d9a754fd34 30 pc.scanf("%d", &pomak);
tim010 0:05d9a754fd34 31 int brojKoraka = (int)pomak;
tim010 0:05d9a754fd34 32 motor.step(brojKoraka, smjer, brzina);
tim010 0:05d9a754fd34 33 }
tim010 0:05d9a754fd34 34 else if(izbor == '2'){
tim010 0:05d9a754fd34 35 smjer = (smjer + 1) % 2;
tim010 0:05d9a754fd34 36 }
tim010 0:05d9a754fd34 37 else if(izbor == '3'){
tim010 0:05d9a754fd34 38 pc.printf("Unesite novu brzinu");
tim010 0:05d9a754fd34 39 pc.scanf("%d", &brzina);
tim010 0:05d9a754fd34 40
tim010 0:05d9a754fd34 41 }
tim010 0:05d9a754fd34 42 else if(izbor == '4'){
tim010 0:05d9a754fd34 43
tim010 0:05d9a754fd34 44 if(upaljen == false) upaljen = true;
tim010 0:05d9a754fd34 45 else upaljen = false;
tim010 0:05d9a754fd34 46 }
tim010 0:05d9a754fd34 47
tim010 0:05d9a754fd34 48 }
tim010 0:05d9a754fd34 49 }