Jorn Dokter / Mbed 2 deprecated TEB_branch2

Dependencies:   mbed QEI HIDScope biquadFilter MODSERIAL FastPWM

Revision:
50:283a831f84a9
Parent:
49:a9ed4f4cdef7
Child:
53:0aab2185b144
--- a/structures.h	Tue Oct 15 11:34:02 2019 +0000
+++ b/structures.h	Tue Oct 15 11:40:34 2019 +0000
@@ -35,7 +35,13 @@
         float ddY;  //output, delayed twice
         float dX;   //input, delayed once
         float ddX;  //input, delayed twice
-        //void ShiftValues
+        void ShiftValues(float CurX, float CurY) //Input: Current X, current Y
+        {
+            ddY = dY; //Y delayed once to Y delayed twice
+            ddX = dX; //X delayed once to X delayed twice 
+            dY = CurY; //Current Y to Y delayed once
+            dX = CurX; //Current X to X delayed once
+        }
     };