Add new Filter class to filter position and velocity quantities given to the MPC (4th-order Butterworth filter to low-pass at 25Hz)