6.5.2 基于速度的卡尔曼滤波器
文件Kalman_Filter_velocity.py实现了基于速度的卡尔曼滤波器,用于估计机器人的速度。在这个基于速度的卡尔曼滤波器中,使用真实轨迹位置计算理论速度,然后利用以下卡尔曼滤波器追踪x和y方向上的速度。下面是该滤波器参数的具体说明。
(2)过程噪声协方差矩阵Q
过程噪声协方差矩阵 Q 通过设置非零元素来建模系统中的不确定性,其形式为:
文件Kalman_Filter_velocity.py实现了基于速度的卡尔曼滤波器,用于估计机器人的速度。在这个基于速度的卡尔曼滤波器中,使用真实轨迹位置计算理论速度,然后利用以下卡尔曼滤波器追踪x和y方向上的速度。下面是该滤波器参数的具体说明。
(2)过程噪声协方差矩阵Q
过程噪声协方差矩阵 Q 通过设置非零元素来建模系统中的不确定性,其形式为: