Werkende PID regelaar met PC input, nieuwe constanten (Kp etc) nog niet toegevoegd.
Dependencies: HIDScope MODSERIAL QEI biquadFilter mbed
Fork of frdm_Motor_V2_4 by
Revision 29:c1f4467bfd19, committed 2015-10-26
- Comitter:
- Rvs94
- Date:
- Mon Oct 26 19:55:11 2015 +0000
- Parent:
- 28:d0b26cfe5d80
- Commit message:
- Werkende PID regelaar met PC input, geschikt voor constructie, zonder nieuwe K constanten (moet nog worden toegevoegd)
Changed in this revision
main.cpp | Show annotated file Show diff for this revision Revisions of this file |
diff -r d0b26cfe5d80 -r c1f4467bfd19 main.cpp --- a/main.cpp Mon Oct 26 10:18:05 2015 +0000 +++ b/main.cpp Mon Oct 26 19:55:11 2015 +0000 @@ -39,7 +39,7 @@ double m2_ref = 0, m1_ref = 0; int count = 0; double Grens2 = 90, Grens1 = 90; - double Stapgrootte = 5; + double Stapgrootte = 1; //Sample time (motor-step) const double m2_Ts = 0.001, m1_Ts = 0.01; @@ -199,8 +199,8 @@ m1_ref = m1_ref - Stapgrootte; if (m2_ref < -1*Grens2) { - m2_ref = Grens2; - m1_ref = Grens1; + m2_ref = -1*Grens2; + m1_ref = -1*Grens1; } } }