NLFilter:

Path: Common/Control

% Implements a nonlinear fixed gain filter.

   Implements a nonlinear fixed gain filter of the form

   dx/dt = f(x,u,t) + k*(y - h(x,u,t))

   f and h are strings giving the names of functions.

   f is of the form f( x, t, u, k, y, h )
   h is of the form h( x, u, t )

   A 4th order Runge-Kutta is used to propagate the equations of motion.

--------------------------------------------------------------------------
   Form:
   x = NLFilter( f, h, x, t, k, u, y, dT )
--------------------------------------------------------------------------

   ------
   Inputs
   ------
   f                   Right hand side of the differential equations
   h                   Measurement equations
   x                   State vector
   t                   Time
   k                   Gain matrix
   u                   Known inputs
   y                   Actual measurements
   dT                  Time step

   -------
   Outputs
   -------
   x                   State vector

--------------------------------------------------------------------------

Children:

Math: Integration/RK4

Back to the Common Module page