pour bastos

Dependencies:   mbed

Committer:
vermaelen
Date:
Wed Apr 06 12:25:35 2022 +0000
Revision:
0:e2ce7aa2a4a4
v2

Who changed what in which revision?

UserRevisionLine numberNew contents of line
vermaelen 0:e2ce7aa2a4a4 1 #include "mbed.h"
vermaelen 0:e2ce7aa2a4a4 2 #include "lib.h"
vermaelen 0:e2ce7aa2a4a4 3
vermaelen 0:e2ce7aa2a4a4 4 void fct()
vermaelen 0:e2ce7aa2a4a4 5 {
vermaelen 0:e2ce7aa2a4a4 6 if(cPosD==0)cPosD=220;
vermaelen 0:e2ce7aa2a4a4 7 else cPosD=0;
vermaelen 0:e2ce7aa2a4a4 8 if(cPosG==0)cPosG=220;
vermaelen 0:e2ce7aa2a4a4 9 else cPosG=0;
vermaelen 0:e2ce7aa2a4a4 10 }
vermaelen 0:e2ce7aa2a4a4 11 void aff2(){
vermaelen 0:e2ce7aa2a4a4 12 printf("cPosG=%d -- cptG=%d -- cmdG=%d -- cPos=%.2f\n\r",cPosG,cptG,cmdG,cPos);
vermaelen 0:e2ce7aa2a4a4 13 }
vermaelen 0:e2ce7aa2a4a4 14 int main()
vermaelen 0:e2ce7aa2a4a4 15 {
vermaelen 0:e2ce7aa2a4a4 16 init();
vermaelen 0:e2ce7aa2a4a4 17 //tac.attach(&aff2,0.5);
vermaelen 0:e2ce7aa2a4a4 18 while(1) {
vermaelen 0:e2ce7aa2a4a4 19 //printf("erD=%d -- somErD=%d -- cptD=%d -- cmd=%d\n\r",erD,somErD,cptD,cmdD);
vermaelen 0:e2ce7aa2a4a4 20 printf("Go !!\n\r");
vermaelen 0:e2ce7aa2a4a4 21
vermaelen 0:e2ce7aa2a4a4 22 distance(2000);
vermaelen 0:e2ce7aa2a4a4 23
vermaelen 0:e2ce7aa2a4a4 24 rotation(180);
vermaelen 0:e2ce7aa2a4a4 25 distance(1000);
vermaelen 0:e2ce7aa2a4a4 26 rotation(360);
vermaelen 0:e2ce7aa2a4a4 27 distance(1000);
vermaelen 0:e2ce7aa2a4a4 28 rotation(-180);
vermaelen 0:e2ce7aa2a4a4 29
vermaelen 0:e2ce7aa2a4a4 30 wait(2);
vermaelen 0:e2ce7aa2a4a4 31
vermaelen 0:e2ce7aa2a4a4 32 }
vermaelen 0:e2ce7aa2a4a4 33 }