![](/media/cache/img/default_profile.jpg.50x50_q85.jpg)
Armin, Kenan
main.cpp@0:3b0e2caa6ad4, 2014-05-12 (annotated)
- Committer:
- tim010
- Date:
- Mon May 12 16:01:59 2014 +0000
- Revision:
- 0:3b0e2caa6ad4
PAI_LV9_Grupa3_Tim010
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
tim010 | 0:3b0e2caa6ad4 | 1 | #include "mbed.h" |
tim010 | 0:3b0e2caa6ad4 | 2 | #include "motor.h" |
tim010 | 0:3b0e2caa6ad4 | 3 | |
tim010 | 0:3b0e2caa6ad4 | 4 | Serial pc(USBTX, USBRX); |
tim010 | 0:3b0e2caa6ad4 | 5 | motor mt(dp13, dp11, dp10, dp9); |
tim010 | 0:3b0e2caa6ad4 | 6 | Ticker tick; |
tim010 | 0:3b0e2caa6ad4 | 7 | |
tim010 | 0:3b0e2caa6ad4 | 8 | int brzina = 1200 ; // set default motor speed |
tim010 | 0:3b0e2caa6ad4 | 9 | int brojKoraka = 512 ; |
tim010 | 0:3b0e2caa6ad4 | 10 | |
tim010 | 0:3b0e2caa6ad4 | 11 | void komunikacija() { |
tim010 | 0:3b0e2caa6ad4 | 12 | char c = pc.getc(); |
tim010 | 0:3b0e2caa6ad4 | 13 | while (c != '0' && c != '1' && c != '2' && c != '3' && c != '4' && c!='5') |
tim010 | 0:3b0e2caa6ad4 | 14 | c = pc.getc(); |
tim010 | 0:3b0e2caa6ad4 | 15 | pc.printf("Char %c\n", c); |
tim010 | 0:3b0e2caa6ad4 | 16 | if (c=='1') |
tim010 | 0:3b0e2caa6ad4 | 17 | mt.korak(brojKoraka,0,brzina); // number of steps, direction, speed |
tim010 | 0:3b0e2caa6ad4 | 18 | |
tim010 | 0:3b0e2caa6ad4 | 19 | if (c=='2') |
tim010 | 0:3b0e2caa6ad4 | 20 | mt.korak(brojKoraka,1,brzina); |
tim010 | 0:3b0e2caa6ad4 | 21 | |
tim010 | 0:3b0e2caa6ad4 | 22 | if (c=='3') |
tim010 | 0:3b0e2caa6ad4 | 23 | mt.korak(brojKoraka/2,0,brzina); |
tim010 | 0:3b0e2caa6ad4 | 24 | |
tim010 | 0:3b0e2caa6ad4 | 25 | if (c=='4') |
tim010 | 0:3b0e2caa6ad4 | 26 | mt.korak(brojKoraka/2,1,brzina); |
tim010 | 0:3b0e2caa6ad4 | 27 | |
tim010 | 0:3b0e2caa6ad4 | 28 | if (c=='5') { |
tim010 | 0:3b0e2caa6ad4 | 29 | pc.printf("Current Speed: %d\n\r", brzina); |
tim010 | 0:3b0e2caa6ad4 | 30 | pc.printf("New speed: \n\r"); |
tim010 | 0:3b0e2caa6ad4 | 31 | pc.scanf("%d",&brzina); // sets new speed |
tim010 | 0:3b0e2caa6ad4 | 32 | } |
tim010 | 0:3b0e2caa6ad4 | 33 | } |
tim010 | 0:3b0e2caa6ad4 | 34 | |
tim010 | 0:3b0e2caa6ad4 | 35 | int main() { |
tim010 | 0:3b0e2caa6ad4 | 36 | // Screen Menu |
tim010 | 0:3b0e2caa6ad4 | 37 | pc.printf("Osnovna brzina: %d\n\r",brzina); |
tim010 | 0:3b0e2caa6ad4 | 38 | pc.printf("1- 360 stepeni naprijed\n\r"); |
tim010 | 0:3b0e2caa6ad4 | 39 | pc.printf("2- 360 stepeni nazad\n\r"); |
tim010 | 0:3b0e2caa6ad4 | 40 | pc.printf("3- 180 stepeni naprijed\n\r"); |
tim010 | 0:3b0e2caa6ad4 | 41 | pc.printf("4- 180 stepeni nazad\n\r"); |
tim010 | 0:3b0e2caa6ad4 | 42 | pc.printf("5- Promijeni brzinu\n\r"); |
tim010 | 0:3b0e2caa6ad4 | 43 | //pc.attach(&komunikacija); |
tim010 | 0:3b0e2caa6ad4 | 44 | |
tim010 | 0:3b0e2caa6ad4 | 45 | while(1) { |
tim010 | 0:3b0e2caa6ad4 | 46 | char c = pc.getc(); |
tim010 | 0:3b0e2caa6ad4 | 47 | //while (c != 'a' && c != 'b' && c != 'c' && c != 'd' && c != 'e' && c!='f') |
tim010 | 0:3b0e2caa6ad4 | 48 | //c = pc.getc(); |
tim010 | 0:3b0e2caa6ad4 | 49 | //pc.printf("Char %c\n", c); |
tim010 | 0:3b0e2caa6ad4 | 50 | if (c=='a') |
tim010 | 0:3b0e2caa6ad4 | 51 | mt.korak(brojKoraka,0,brzina); // number of steps, direction, speed |
tim010 | 0:3b0e2caa6ad4 | 52 | |
tim010 | 0:3b0e2caa6ad4 | 53 | if (c=='b') |
tim010 | 0:3b0e2caa6ad4 | 54 | mt.korak(brojKoraka,1,brzina); |
tim010 | 0:3b0e2caa6ad4 | 55 | |
tim010 | 0:3b0e2caa6ad4 | 56 | if (c=='d') |
tim010 | 0:3b0e2caa6ad4 | 57 | mt.korak(brojKoraka/2,0,brzina); |
tim010 | 0:3b0e2caa6ad4 | 58 | |
tim010 | 0:3b0e2caa6ad4 | 59 | if (c=='e') |
tim010 | 0:3b0e2caa6ad4 | 60 | mt.korak(brojKoraka/2,1,brzina); |
tim010 | 0:3b0e2caa6ad4 | 61 | |
tim010 | 0:3b0e2caa6ad4 | 62 | if (c=='f') { |
tim010 | 0:3b0e2caa6ad4 | 63 | pc.printf("Current Speed: %d\n\r", brzina); |
tim010 | 0:3b0e2caa6ad4 | 64 | pc.printf("New speed: \n\r"); |
tim010 | 0:3b0e2caa6ad4 | 65 | pc.scanf("%d",&brzina); // sets new speed |
tim010 | 0:3b0e2caa6ad4 | 66 | } |
tim010 | 0:3b0e2caa6ad4 | 67 | if (c=='g') { |
tim010 | 0:3b0e2caa6ad4 | 68 | pc.printf("\nStepeni: "); |
tim010 | 0:3b0e2caa6ad4 | 69 | float stepeni(0); |
tim010 | 0:3b0e2caa6ad4 | 70 | pc.scanf("%f", &stepeni); |
tim010 | 0:3b0e2caa6ad4 | 71 | float temp(stepeni/5.625); |
tim010 | 0:3b0e2caa6ad4 | 72 | mt.korak(brojKoraka/(64/temp),0,brzina); |
tim010 | 0:3b0e2caa6ad4 | 73 | } |
tim010 | 0:3b0e2caa6ad4 | 74 | } |
tim010 | 0:3b0e2caa6ad4 | 75 | |
tim010 | 0:3b0e2caa6ad4 | 76 | |
tim010 | 0:3b0e2caa6ad4 | 77 | } |