tim010 tim010 / Mbed 2 deprecated PAI_LV9_Grupa3_Tim010_Zadatak2

Armin, Kenan

Dependencies:   mbed

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?

UserRevisionLine numberNew 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 }