|
| | 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 | 观测量个数 |