基于MCU的室外移动机器人组合导航定位系统 航空航天, 机器人, 北京, 大学

我是MT

者: 吴平 张海 北京航空航天大学飞行器控制一体化技术重点实验室 单片机与嵌入式系统应用 上网日期: 2015年04月24日
评论[ 0 ]  分享到:  新浪微博          qq空间          qq微博          百度搜藏  
  字号：

• 1
• 2
• 3
• 4
• 5
• 6
• 7

分步阅读





关键字：MCU   多路数据采集   组合导航   时间对准  



对于在室外环境工作的移动机器人通常使用惯导/卫星组合导航方式。惯性导航系统[1]具有完全自主、抗干扰强、隐蔽能力好和输出参数全面等优点，但它的鲁棒性极低，误差会不断随时间累积发散。卫星导航系统具有精度高、定位范围广和误差不随时间累积等优点，但其自主性差、易受外界遮挡和干扰、接收机数据更新频率低等缺点。因此工程上常常将两者互补结合使用，组成卫星/惯性组合导航系统。本文以低功耗MSP430F149为核心，设计了能够同时实现卫星导航(GNSS)接收机、惯性测量单元(IMU)、气压高度等导航信息的高速采集与高速合路传输，并进行初步导航定位信息融合的导航系统，即可为室外移动机器人提供直接的导航服务，也可作为高精度组合导航系统的原始测量信息高速采集系统。
系统设计的关键是利用单片机有限的接口资源实现了多传感器信息并行采集，设计了有效的数据同步方法，解决了气压传感器数据手册疏漏导致的无法接入问题，给出了机器人组合定位的基本方法。系统充分利用了MSP430F149单片机的能力，具有结构简单、低功耗、对传感器具有普适性等优点。
1 总体设计
本系统由电源、气压计接口、IMU接口、GNSS接收机接口、SPI转UART模块及MSP430F149构成。系统组成如图1所示。
组合导航系统的功能实现分为IMU数据接收与解析、GNSS数据接收与解析、气压计数据接收与解析、组合导航解算以及数据输出五个部分。IMU数据接收与解析功能用来获取导航解算中需要的加速度和角速度信息；GNSS数据接收与解析功能用来获取导航解算中需要的位置和速度信息(松耦合组合)或者GNSS伪距和伪距率（紧耦合组合）；气压计数据接收与解析功能用来获取高度信息；组合导航解算功能为系统核心，用来进行组合导航解算；数据的输出包括原始数据包的整合输出和解算结果的输出。



图1 系统组成结构图



本文所使用的惯性器件和GNSS接收机都是RS-232电平的UART接口，具有通用性，用户可根据成本考虑不同精度的设备。气压计选用美国MEAS公司生产的MS5803-02BA，已经固化在电路中。