tim003 tim003
/
PAI_Grupa7_LV9_Tim003_Zadatak2
Nedim Hozić Selma Tucak
main.cpp@0:cf05c790bfca, 2014-05-15 (annotated)
- Committer:
- tim003
- Date:
- Thu May 15 18:15:16 2014 +0000
- Revision:
- 0:cf05c790bfca
PAI-LV9-Zadatak2
Who changed what in which revision?
User | Revision | Line number | New 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 | } |