Added first order filter to smooth the discrete setpoint transitions.