#include <otEKF.h>
Public Member Functions | |
| otEKF () | |
| void | create (otMatrix &XInit, otMatrix &P, otMatrix &Q, otMatrix &R, bool(*bNonlinearUpdateX)(otMatrix &, otMatrix &, otMatrix &), bool(*bNonlinearUpdateY)(otMatrix &, otMatrix &, otMatrix &), bool(*bCalcJacobianF)(otMatrix &, otMatrix &, otMatrix &), bool(*bCalcJacobianH)(otMatrix &, otMatrix &, otMatrix &)) |
| void | vReset (otMatrix &XInit, otMatrix &P, otMatrix &Q, otMatrix &R) |
| bool | bUpdate (otMatrix &Y, otMatrix &U) |
| otMatrix | GetX () |
| otMatrix | GetY () |
| otMatrix | GetP () |
| otMatrix | GetErr () |
| void | close () |
Protected Attributes | |
| bool(* | bNonlinearUpdateX )(otMatrix &X_dot, otMatrix &X, otMatrix &U) |
| bool(* | bNonlinearUpdateY )(otMatrix &Y_Est, otMatrix &X, otMatrix &U) |
| bool(* | bCalcJacobianF )(otMatrix &F, otMatrix &X, otMatrix &U) |
| bool(* | bCalcJacobianH )(otMatrix &H, otMatrix &X, otMatrix &U) |
|
|
Create the class |
|
||||||||||||
|
Run once every sampling time |
|
|
|
|
||||||||||||||||||||||||||||||||||||
|
Initialization: x(k=0|k=0) = Expected value of x at time-0 (i.e. x(k=0)), typically set to zero. P (k=0|k=0) = Identity matrix * covariant(P(k=0)), typically initialized with some big number. Q, R = Covariance matrices of process & measurement. As this implementation the noise as AWGN (and same value for every variable), this is set to Q=diag(QInit,...,QInit) and R=diag(RInit,...,RInit). |
|
|
|
|
|
Return Predicted state estimate |
|
|
|
|
|
|
|
||||||||||||||||||||
|
|
|
|
|
|
|
|
|
|
|
|
|
|