8维状态量:位置(2)+速度(2)+航向角(1)+航向角角速度(1)+加速度(2),2维观测量:XY位置 订阅专栏后,可直接查看源代码,粘贴到MATLAB空脚本中即可直接运行、得到结果 文章目录 运行结果 MATLAB源代码 程序详解 概述 系统架构 核心数学模型 EKF算法流程 预测步骤 更新步骤(当有GNSS观测时) 仿真设置 真实轨迹模型 传感器配置 性能评估 算法特点 运行结果 轨迹对比: 各轴位移与速度曲线对比: 误差对比: 命令行截图: MATLAB源代码 完整代码如下: % 二维状态量的EKF例程(有严格的组合导航推导)