borrowed codes
Dependencies: mbed lib_FRC_2019
Revision 9:234439133426, committed 2019-06-07
- Comitter:
- kyxstark
- Date:
- Fri Jun 07 06:06:52 2019 +0000
- Parent:
- 8:7b0fa8a914c0
- Commit message:
Changed in this revision
main.cpp | Show annotated file Show diff for this revision Revisions of this file |
diff -r 7b0fa8a914c0 -r 234439133426 main.cpp --- a/main.cpp Thu Jun 06 12:34:37 2019 +0000 +++ b/main.cpp Fri Jun 07 06:06:52 2019 +0000 @@ -58,7 +58,8 @@ pc.printf ("\n\r1\n"); wait (1); - motor.setSpeed (0,0); + + //motor.setSpeed (0,0); while (1) { pc.printf ("\rCap = %5.2lf\n", boussole.getBearing()); @@ -98,7 +99,7 @@ motor.getSpeed (&vG, &vD); pc.printf ("\rEtape = %d : x = %5.1lf, y = %5.1lf, theta = %5.1lf - speedG = %5.1lf, speedD = %5.1lf\n", etatmvt, x, y, 180*theta/PI, vG, vD); -/* + switch (etatmvt) { case 0 : // On avance de 50cm (coordonnés X = 500, Y = 0) @@ -157,7 +158,7 @@ } break; } -*/ + pc.printf ("\n\n"); led1 = !led1; led2 = !led2;