tim010 tim010
/
LV9-tim010-grupa-6zad2
Josip Kvesić
Diff: main.cpp
- Revision:
- 1:bc5be4e9b077
- Parent:
- 0:acae693b0964
--- a/main.cpp Thu May 15 15:13:24 2014 +0000 +++ b/main.cpp Thu May 15 16:07:29 2014 +0000 @@ -1,12 +1,59 @@ #include "mbed.h" - -DigitalOut myled(LED1); - +#include "sMotor.h" + + +Serial pc(USBTX, USBRX); +sMotor motor(dp13,dp11,dp10,dp9); + +int brzina = 1200 ; +int brojkoraka = 512 ; +bool p=true; + int main() { - while(1) { - myled = 1; - wait(0.2); - myled = 0; - wait(0.2); + + + pc.printf("Pocetna brzina: %d\n\r",brzina); + pc.printf("1- 360 naprijed\n\r"); + pc.printf("2- 360 nazad\n\r"); + pc.printf("3- 180 naprijed\n\r"); + pc.printf("4- 180 nazad\n\r"); + pc.printf("5- promijena brzine\n\r"); + pc.printf("6-stanin\n\r"); + pc.printf("7-kreni\n\r"); + + + while (1) { + + if (pc.readable()) { + char z; + z=pc.getc(); + + if (z=='1' ) + motor.step(brzina,0,brojkoraka); + + if (z=='2' && p) + motor.step(brzina,1,brojkoraka); + + if (z=='3' && p) + motor.step(brzina/2,0,brojkoraka); + + if (z=='4' && p) + motor.step(brzina/2,1,brojkoraka); + + if (z=='5' && p) { + pc.printf("trenutna brzina: %d\n\r", brzina); + pc.printf("Nova brzina: \n\r"); + pc.scanf("%d",&brzina); + } + if(z=='6'){ + p=false; + motor.step(0,1,brojkoraka); + } + if(z=='7'){ + p=true; + motor.step(brzina,1,brojkoraka); + } + } + } -} +} \ No newline at end of file