Path: Math/FDIR
% Implements a DC motor detection filter. Uses Euler integration. Since version 9. -------------------------------------------------------------------------- Form: [r, xDF] = DCMotorDetectionFilter( 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] --------------------------------------------------------------------------
Back to the Math Module page