Jona Vonk / Mbed OS MoveMotors

Hier zitten extra leipe functies in naast PID ook x en y naar hoeken

Dependencies:   QEI MODSERIAL

Diff: main.cpp

Revision:
3:ecd394ae8118
Parent:
2:f832050b1b4a
Child:
4:5f147787c2ca
--- a/main.cpp	Mon Oct 21 12:28:08 2019 +0000
+++ b/main.cpp	Mon Oct 21 12:32:20 2019 +0000
@@ -86,7 +86,7 @@
         tieme = t.read();
         t.reset();
         //pc.printf("pError: %f dError: %f iError: %f PWM: %f\n\r", pErrorC, dError, iError, MotorPWM);
-    } while (pErrorC > 0.01 || pErrorC < -0.01 ||dError > 0.01 || dError < -0.01);
+    } while (pErrorC > 0.001 || pErrorC < -0.001 ||dError > 0.01 || dError < -0.01);
     //*E = 0;
     t.stop();
 }