#include <RPYKalmanFilter.h>
Public Member Functions | |
const hrp::Vector2 & | getx () |
KFilter () | |
void | resetStateByObservation () |
void | setB (const double _b0, const double _b1) |
void | setF (const double _f0, const double _f1, const double _f2, const double _f3) |
void | setP (const double _p0, const double _p1, const double _p2, const double _p3) |
void | setQ (const double _q0, const double _q1, const double _q2, const double _q3) |
void | setR (const double _R) |
void | update (const double u, const double _z) |
Private Attributes | |
hrp::Vector2 | B |
hrp::Matrix22 | F |
Eigen::Matrix< double, 1, 2 > | H |
hrp::Matrix22 | I |
hrp::Vector2 | K |
hrp::Matrix22 | P |
hrp::Matrix22 | Q |
double | R |
hrp::Vector2 | x |
double | z |
Definition at line 13 of file RPYKalmanFilter.h.
|
inline |
Definition at line 15 of file RPYKalmanFilter.h.
|
inline |
Definition at line 41 of file RPYKalmanFilter.h.
|
inline |
Definition at line 60 of file RPYKalmanFilter.h.
Definition at line 40 of file RPYKalmanFilter.h.
|
inline |
Definition at line 36 of file RPYKalmanFilter.h.
|
inline |
Definition at line 37 of file RPYKalmanFilter.h.
|
inline |
Definition at line 38 of file RPYKalmanFilter.h.
Definition at line 39 of file RPYKalmanFilter.h.
Definition at line 42 of file RPYKalmanFilter.h.
|
private |
Definition at line 66 of file RPYKalmanFilter.h.
|
private |
Definition at line 62 of file RPYKalmanFilter.h.
|
private |
Definition at line 65 of file RPYKalmanFilter.h.
|
private |
Definition at line 62 of file RPYKalmanFilter.h.
|
private |
Definition at line 66 of file RPYKalmanFilter.h.
|
private |
Definition at line 62 of file RPYKalmanFilter.h.
|
private |
Definition at line 62 of file RPYKalmanFilter.h.
|
private |
Definition at line 68 of file RPYKalmanFilter.h.
|
private |
Definition at line 67 of file RPYKalmanFilter.h.
|
private |
Definition at line 68 of file RPYKalmanFilter.h.