8维状态量(2维位置、2维速度、航向角、航向角偏置、2维加速度计偏置)+4维观测量(2维位置、2维速度)。 订阅专栏后,可直接查看源代码,粘贴到MATLAB空脚本中即可直接运行、得到结果 文章目录 运行结果 MATLAB源代码 程序详解 📘 程序概述 状态预测(状态转移函数) 状态雅可比矩阵 EKF 预测与更新 ⚙️ 核心代码片段 运行结果 定位导航轨迹示意图: 各方法得到的XY两个轴的位移-时间图像: 各方法得到的XY两各轴的速度-时间图像: 各方法得到的位置误差与速度误差: