32 #ifndef _MOTIONMODEL_H_
33 #define _MOTIONMODEL_H_
35 #include <Eigen/Dense>
Nonholonomic extended Kalman filter class.
nonholonomic Kalman filter
Vector3d _z
Measurement vector.
Eigen::Matrix< double, 3, 1 > Vector3d
void initEstimator(Vector5d &x, Matrix5d &P)
Vector5d _x
Estimated state.
Nonholonomic Motion model abstraction layer.
nonholonomicEKFilter _estimator
Local estimator for process, Kalman filter with a constant velocity.
Matrix5d _P
Posteriori error covariance.
Eigen::Matrix< double, 5, 5 > Matrix5d
Eigen::Matrix< double, 5, 1 > Vector5d
void stepEstimator(Vector3d z)