Using HIDScope for P(I)D controller
Dependencies: FastPWM HIDScope MODSERIAL QEI biquadFilter mbed
Fork of PES_tutorial_5 by
Diff: main.cpp
- Revision:
- 19:1353ba4d94db
- Parent:
- 17:4a0912c93771
- Child:
- 20:e00e41e3cda8
diff -r 4a0912c93771 -r 1353ba4d94db main.cpp --- a/main.cpp Fri Oct 19 12:08:31 2018 +0000 +++ b/main.cpp Mon Oct 22 08:54:04 2018 +0000 @@ -26,7 +26,12 @@ //------------------------------------------------------------------------------ // Functions - +double Filters() +{ + static BiQuad Notchfilter(1.0000, -1.6180, 1.0000, 1.0000, -1.5687, 0.9391); + static BiQuad HighPassFilter (1.0000, -2.0000, 1.0000, 1.0000, -1.8268, 0.8407); + static BiQuad LowPassFilter (1.0000, 2.0000, 1.0000, 1.0000, 0.3172, 0.1894); +} double GetReferencePosition() { double potMeterIn = potMeter1.read();