Nedim Hozić Selma Tucak

Dependencies:   mbed sMotor

Committer:
tim003
Date:
Thu May 15 18:15:16 2014 +0000
Revision:
0:cf05c790bfca
PAI-LV9-Zadatak2

Who changed what in which revision?

UserRevisionLine numberNew contents of line
tim003 0:cf05c790bfca 1 #include "mbed.h"
tim003 0:cf05c790bfca 2 #include "sMotor.h"
tim003 0:cf05c790bfca 3
tim003 0:cf05c790bfca 4 Serial pc(USBTX, USBRX);
tim003 0:cf05c790bfca 5 sMotor motor(dp13, dp11, dp10, dp9);
tim003 0:cf05c790bfca 6
tim003 0:cf05c790bfca 7 int step_speed = 0;
tim003 0:cf05c790bfca 8 int numstep = 512;
tim003 0:cf05c790bfca 9 int direction = 0;
tim003 0:cf05c790bfca 10 int main() {
tim003 0:cf05c790bfca 11 pc.printf("O - Postavljanje osovine u proizvoljan polozaj. \n");
tim003 0:cf05c790bfca 12 pc.printf("P - Promjena smjera okretanja. \n");
tim003 0:cf05c790bfca 13 pc.printf("B - Promjena brzine okretanja. \n");
tim003 0:cf05c790bfca 14 pc.printf("K - Pokreni motor. \n");
tim003 0:cf05c790bfca 15 pc.printf("S - Zustavi motor. \n");
tim003 0:cf05c790bfca 16 pc.printf("Trenutna brzina je %d", step_speed);
tim003 0:cf05c790bfca 17 step_speed=1200;
tim003 0:cf05c790bfca 18 while(1) {
tim003 0:cf05c790bfca 19 if(pc.readable())
tim003 0:cf05c790bfca 20 {
tim003 0:cf05c790bfca 21 char a = pc.getc();
tim003 0:cf05c790bfca 22 if(a=='O')
tim003 0:cf05c790bfca 23 {
tim003 0:cf05c790bfca 24 int ugao;
tim003 0:cf05c790bfca 25 pc.printf("\nUnesi ugao: ");
tim003 0:cf05c790bfca 26 pc.scanf("%d", &ugao);
tim003 0:cf05c790bfca 27 numstep = (ugao/360.00)*512;
tim003 0:cf05c790bfca 28 motor.step(numstep,direction,step_speed);
tim003 0:cf05c790bfca 29 }
tim003 0:cf05c790bfca 30 if(a=='P')
tim003 0:cf05c790bfca 31 {
tim003 0:cf05c790bfca 32 numstep = 512;
tim003 0:cf05c790bfca 33 if(direction==0)
tim003 0:cf05c790bfca 34 {
tim003 0:cf05c790bfca 35 motor.anticlockwise();
tim003 0:cf05c790bfca 36 direction = 1;
tim003 0:cf05c790bfca 37 }
tim003 0:cf05c790bfca 38 else
tim003 0:cf05c790bfca 39 {
tim003 0:cf05c790bfca 40 motor.clockwise();
tim003 0:cf05c790bfca 41 direction = 0;
tim003 0:cf05c790bfca 42 }
tim003 0:cf05c790bfca 43 motor.step(numstep,direction,step_speed);
tim003 0:cf05c790bfca 44 }
tim003 0:cf05c790bfca 45 if(a=='B')
tim003 0:cf05c790bfca 46 {
tim003 0:cf05c790bfca 47 pc.printf("Trenutna brzina je %d, unesite novu: ");
tim003 0:cf05c790bfca 48 pc.scanf("%d", &step_speed);
tim003 0:cf05c790bfca 49 motor.step(numstep,direction,step_speed);
tim003 0:cf05c790bfca 50 }
tim003 0:cf05c790bfca 51 if(a=='K')
tim003 0:cf05c790bfca 52 {
tim003 0:cf05c790bfca 53 if(step_speed==0)
tim003 0:cf05c790bfca 54 step_speed = 1200;
tim003 0:cf05c790bfca 55 motor.step(numstep,direction,step_speed);
tim003 0:cf05c790bfca 56 }
tim003 0:cf05c790bfca 57 if(a=='S')
tim003 0:cf05c790bfca 58 {
tim003 0:cf05c790bfca 59 motor.step(0,direction,step_speed);
tim003 0:cf05c790bfca 60 }
tim003 0:cf05c790bfca 61 }
tim003 0:cf05c790bfca 62 }
tim003 0:cf05c790bfca 63 }