STM32自主定位的小车导航系统设计
2016-01-26王玥张海
单片机与嵌入式系统应用 2015年12期
王玥,张海
(北京航空航天大学 自动化科学与电气工程学院,北京 100191)
王玥,张海
(北京航空航天大学 自动化科学与电气工程学院,北京 100191)
摘要:设计了基于STM32F103VET6的自主定位四轮差速小车。为单轴陀螺仪ADIS16265、集成惯性测量单元MPU-9150及超声波测距模块设计了合理的数据采集与处理方法,完成小车短时间内高精度的航向角计算及长时间稳定的磁航向角计算,并对程序开发中遇到的堆栈溢出问题提出了解决方案。最后提出了各传感器信息的有效融合方法,采用航位推算的方法完成小车自主定位,实现了小车长时间沿预定轨迹自主稳定行驶的功能。
关键词:STM32;ADIS16265;MPU-9150;磁航向角;堆栈溢出
引言
本文采用惯性/码盘/磁罗盘/超声波测距组合的方式,在测量数据融合的基础上实现小车的自主导航定位,并通过电机调速控制实现了车辆的自主定位。
1方案选择
小车的导航与控制系统由导航/控制解算模块、惯性/距离/测速传感器、电机调速控制电路、WiFi无线通信模块等构成,系统组成及主控芯片接口分配如图1所示。

图1 系统组成及主控芯片接口分配图
车辆采用4轮差速控制,每个减速电机上装有光电码盘测量电机的实际转速。
主控芯片在采集到传感器数据后进行小车导航定位信息的解算。已知初始航向、位置信息,利用陀螺仪测量的航向角速度信息积分得到短时间内精确的小车航向角信息,加上光电码盘测得的车轮转速信息,通过航位推算的方法获得小车定位信息。……
登录APP查看全文
