卡尔曼滤波静态数据 更多...
#include <rmvl/algorithm/kalman.hpp>
Public 成员函数 | |
KalmanFilterStaticDatas () | |
构造新的卡尔曼滤波静态数据 | |
void | init (const cv::Matx< Tp, StateDim, 1 > &x0, Tp error) |
初始化状态以及对应的误差协方差矩阵(常数对角矩阵) | |
void | init (const cv::Matx< Tp, StateDim, 1 > &x0, const cv::Matx< Tp, StateDim, 1 > &error) |
初始化状态以及对应的误差协方差矩阵(对角矩阵) | |
void | setR (const cv::Matx< Tp, MeasureDim, MeasureDim > &measure_err) |
设置测量噪声协方差矩阵 R | |
void | setQ (const cv::Matx< Tp, StateDim, StateDim > &process_err) |
设置过程噪声协方差矩阵 Q | |
void | setP (const cv::Matx< Tp, StateDim, StateDim > &state_err) |
设置误差协方差矩阵 P | |
Protected 属性 | |
cv::Matx< Tp, StateDim, 1 > | x |
状态的后验估计 \hat{\pmb x} | |
cv::Matx< Tp, StateDim, 1 > | x_ |
状态的先验估计 \hat{\pmb x}^- | |
cv::Matx< Tp, MeasureDim, 1 > | z |
观测向量 \pmb z | |
cv::Matx< Tp, StateDim, StateDim > | Q |
过程噪声协方差矩阵 Q | |
cv::Matx< Tp, MeasureDim, MeasureDim > | R |
测量噪声协方差矩阵 R | |
cv::Matx< Tp, StateDim, StateDim > | P |
后验误差协方差矩阵 P | |
cv::Matx< Tp, StateDim, StateDim > | P_ |
先验误差协方差矩阵 P^- | |
cv::Matx< Tp, StateDim, StateDim > | I |
单位矩阵 I | |
cv::Matx< Tp, StateDim, MeasureDim > | K |
卡尔曼增益 K | |
卡尔曼滤波静态数据
Tp | 数据类型 |
StateDim | 状态量个数 |
MeasureDim | 观测量个数 |
|
inline |
构造新的卡尔曼滤波静态数据
|
inline |
初始化状态以及对应的误差协方差矩阵(对角矩阵)
[in] | x0 | 初始化的状态向量 |
[in] | error | 状态误差矩阵的对角线元素 |
|
inline |
初始化状态以及对应的误差协方差矩阵(常数对角矩阵)
[in] | x0 | 初始化的状态向量 |
[in] | error | 状态误差系数 |
|
inline |
设置误差协方差矩阵 P
[in] | state_err | 误差协方差矩阵 P |
|
inline |
设置过程噪声协方差矩阵 Q
[in] | process_err | 过程噪声协方差矩阵 Q |
|
inline |
设置测量噪声协方差矩阵 R
[in] | measure_err | 测量噪声协方差矩阵 R |
|
protected |
单位矩阵 I
|
protected |
卡尔曼增益 K
|
protected |
后验误差协方差矩阵 P
|
protected |
先验误差协方差矩阵 P^-
|
protected |
过程噪声协方差矩阵 Q
|
protected |
测量噪声协方差矩阵 R
|
protected |
状态的后验估计 \hat{\pmb x}
|
protected |
状态的先验估计 \hat{\pmb x}^-
|
protected |
观测向量 \pmb z