|
| 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\)
|
|
|
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\)
|
|
template<typename Tp, unsigned StateDim, unsigned MeasureDim>
class rm::KalmanFilterStaticDatas< Tp, StateDim, MeasureDim >
卡尔曼滤波静态数据
- 模板参数
-
Tp | 数据类型 |
StateDim | 状态量个数 |
MeasureDim | 观测量个数 |