christophe vermaelen
/
TEST_ASSER_MOT_ENCODEUR_V2
pour bastos
main.cpp@0:e2ce7aa2a4a4, 2022-04-06 (annotated)
- Committer:
- vermaelen
- Date:
- Wed Apr 06 12:25:35 2022 +0000
- Revision:
- 0:e2ce7aa2a4a4
v2
Who changed what in which revision?
User | Revision | Line number | New 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 | } |