基于ARM和DSP的微小型组合导航系统研究

摘要

微小型组合导航系统能够充分发挥各导航子系统的优点，弥补各自的不足，并扩展了组合导航系统的应用范围，是当前导航技术研究的热点。微小型组合导航系统是利用MEMS技术的微惯性测量单元为核心，以GPS或者其它定位方法作为辅助，使用信息融合的方法有效的提高系统的精度和可靠性。本文以社区监控机器人的应用为背景完成基于ARM和DSP的微小型组合导航系统方案设计。
　　 本文在捷联惯性导航原理和GPS原理的基础上，逐步对整个微小型组合导航系统展开研究。首先确立微小型组合导航系统方案，导航计算机采用ARM和DSP的双CPU结构，将整个系统分解为数据采集模块和捷联解算模块；针对微惯性测量单元误差较大的问题，采用通过试验的方法对惯性导航系统误差进行建模和仿真分析，提出能够影响导航精度的主要因子。
　　 其次，研究捷联解算的原理，对比多种解算方法之后采用基于四元数的捷联解算方法。根据最小方差估计推导出卡尔曼滤波，针对卡尔曼滤波原理提出卡尔曼滤波在组合导航中应用应该注意的问题；根据贝叶斯估计推出了粒子滤波，提出粒子滤波在组合导航系统中应用的方案，能够有效的解决粒子滤波的粒子退化问题。
　　 分析捷联惯性导航系统中的误差形式和GPS的误差形式，根据各子系统的误差模型建立滤波方程，采用位置速度的组合模式，建立组合导航系统模型。并且在Matlab软件中设计轨迹发生器，用来模拟导航参数。根据建立的模型和设置的仿真参数，设计EKF、UKF、PF滤波算法进行系统仿真，并利用统计学的方法对多次仿真结果进行综合分析，实验结果表明PF的滤波精度最高但是运算时间最长，使系统不能满足实时性需求，UKF滤波精度能够满足系统需求，运算时间大约是EKF的运算时间的1.2倍，但也能满足实时性要求，EKF滤波精度最低。
　　 最后，根据室外监控机器人自身设备要求和导航计算机的发展趋势，设计基于ARM和DSP的微小型组合导航系统。在基于分布式模块化设计方案的基础上完成了微小型组合导航系统的硬、软件开发。其中在任务管理模块完成了数据采集和串口通信程序，在数据处理模块完成了捷联惯性导航系统的捷联解算算法和组合导航的UKF滤波算法程序。利用机器人自带的机载计算机完成能够用3D模型直观显示运动状态的人机交互软件的设计。通过最终的跑车试验，验证了本文所设计的微小型组合导航系统的可行性，为室外机器人的导航定位工程化奠定了基础。