Using HIDScope for P(I)D controller

Dependencies:   FastPWM HIDScope MODSERIAL QEI biquadFilter mbed

Fork of PES_tutorial_5 by BMT Module 9 Group 4

Revision:
19:1353ba4d94db
Parent:
17:4a0912c93771
Child:
20:e00e41e3cda8
--- 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();