------------------------------------------------------------------------------- Implements a DC motor detection filter. Uses Euler integration. ------------------------------------------------------------------------------- Form: [r, xDF] = DetectionFilter( y, v, dT, xDF, alpha, beta, tau ) ------------------------------------------------------------------------------- ------ Inputs ------ y (2,1) Measurement vector [theta;omega] v (1,:) Motor input voltage dT (1,1) Time step (sec) xDF (2,1) State estimate [theta;omega] alpha (1,1) Motor input constant beta (1,1) Motor rate constant tau (1,1) Filter time constant ------- Outputs ------- r (2,1) Residuals [theta;omega] xDF (2,1) State estimate [theta;omega] -------------------------------------------------------------------------------