设计了一款具有倾斜补偿功能的三轴磁阻电子罗盘,并对样机系统做了误差补偿。本系统以磁阻传感器HMC1043和MEMS加速度传感器ADXL203为信号采集模块,以MSP430F149单片机为信号处理模块,分别获取、处理磁场和重力加速度信息,井通过液晶显示模块LCM6432ZK显示载体的航向角和姿态角。结合经典的椭圓假设法和傅里叶级数模型,对系统的误差进行补偿。实验结果表明,设计的磁阻电子罗盘实现了集成化和智能化,能实时显示载体的航向角和姿态角,航向误差可稳定在±0.6°以内。
引言
电子罗盘是利用地磁场来实现定向功能的装置,已广泛应用于各种导航定位系统。单片机技术的广泛应用,结合利用先进加工工艺生产的磁阻传感器,为导航系统的数字化提供了有利的帮助,是未来电子罗盘的发展方向。因自身的误差及环境磁场的影响,电子罗盘的航向测量精度不高。参考文献提出的24位置最小二乘罗差补偿法虽然精度高,但不能自动补偿;参考文献的最佳椭圆假设补偿法误差可达到±1°。本文基于磁阻传感器HMC1043和MEMS加速度传感器ADXL203研制了一款电子罗盘样机,经过数据预处理和算法补偿后的罗盘系统航向角精度可以稳定在±0.6°以内,该罗盘结构简单,体积小,重量轻,有较好的应用前景。
1 系统结构及硬件组成
本文研制的电子罗盘框图如图1所示。
该系统基于磁阻效应,根据磁场大小确定方向,三轴磁阻传感器HMC1043感测载体坐标系下地球磁场X、Y、Z轴的分量Ux1、Uy1、Uz1。ME MS加速度计ADXL203通过感知地球重力加速度在其测量轴上的分量大小而确定俯仰角φ和翻滚角θ,根据理论公式——式(1)可求得折算到地平坐标系中相同航向下地磁场在X轴和Y轴的分量Hx和Hy,则航向角φ可根据式(2)求得。
磁阻传感器输出信号采用高精度仪器放大器AD623进行放大;由芯片IRF7509及其外围电路将控制器产生的矩形脉冲转换成大电流脉冲,使磁阻传感器置位/复位,以消除磁阻传感器的偏置和放大器的失调及漂移;主控制器采用德州仪器公司的超低功耗的16位单片机MSP430 F149,信号经主控制器处理后送LCD显示航向角和姿态角,亦可实现D/A转换和串口输出。
2 电子罗盘误差补偿
电子罗盘利用地球磁场确定载体的航向,而地球磁场强度仅有0.5~0.6 gauss,极易受到外界磁场环境的影响,又由于传感器本身在制造、安装过程中不可避免地会存在一些误差,磁阻电子罗盘的误差不可避免,从而影响到精度。有资料表明:当车辆沿一座钢铁桥梁直行时,角速率陀螺指示的航向变化很小,而电子罗盘指示的航向变化幅度超过100°。修正这些误差仅仅通过硬件措施不能很好地解决,还必须借助有效的软件补偿方法才能完成。
本文软件方面采用中值滤波算法对数据进行预处理,从而保证A/D采样的稳定性;根据经典椭圆假设理论,将椭圆中心移至原点,将Y轴作为基准对X轴进行校正,在此基础上再对罗差构造数学模型,采用最小二乘法求取罗差补偿系数对罗差进行补偿。
2.1 原点校正原理
根据Michel Moulin等人提出的椭圆假设,在用于地面车辆时,罗盘系统的误差形成过程可认为是传感器测出的水平面上两个磁场分量的合成向量顶点在平面上由一个圆变成了一个椭圆的过程,其逆过程就是基于椭圆假设的误差补偿过程。该方法虽然易于实现自动补偿和校准,但是样机用该方法实验测得系统精度仅为±2°。本文首先采用该方法将椭圆中心移至原点,然后将Y轴作为基准对X轴进行校正,在此基础上再构建罗差模型进行补偿校正。
首先,将椭圆中心移到原点。将罗盘水平旋转一周采样,采样的X、Y轴的最大、最小值分别记作Xmax、Xmin、Ymax、Ymin,可根据式(3)~(6)求得X、Y轴的输出中点Xo、Yo和输出范围Xrang、Yrang:
根据椭圆假设,可认为椭圆是由X、Y轴灵敏度不同造成,同时根据样机的实际运行情况可知,Y轴的输出范围比X轴大,所以可将Y轴定为基准1,继而用式(9)对X轴灵敏度进行校正。
式(8)、(9)即为经过椭圆原点校正后的X、Y轴输出。此时解算出的航向角误差如图2所示。
2.2 罗差校正原理
罗差是利用地球磁场测量航向时电子罗盘系统所特有的一种误差,也是对精度影响最大的一种误差。罗差是由磁阻传感器周围的铁磁材料影响而产生的航向误差,可以分为硬磁材料引起的罗差和软磁材料引起的罗差。
根据参考文献介绍的基于最小二乘24位置罗差补偿法,可得由硬磁材料和软磁材料引起的总罗差为:
△φ=A+Bsinφ+Ccosφ+Dsin(2φ)+Ecos(2φ) (10)
式中,A、B、C、D、E为罗差补偿系数,则消除罗差后的罗盘航向角φc为:
φc=φ-△φ (11)
根据最小二乘原理求取最小二乘解。
5项罗差校正公式,即式(10)实现了对圆周误差、半圆误差和象限误差的补偿,但传感器不对称误差并未得到补偿。经过对误差特性曲线的分析,是3倍角罗差项分量偏大所致,为提高精度,增加3倍角罗差项,构成7项罗差校正公式,即:
△φ=A+Bsinφ+Ccosφ+Dsin(2φ)+Ecos(2φ)+Fsin(3φ)+Gsin(3φ) (12)
实验表明,增加3倍角罗差项可提高精度,但效果有限,且会增加单片机系统负担,故最终选择5项罗差校正公式进行罗差校正。
样机在0~360°范围内,每隔15°对共24个实验点进行测试,得到24组采样数据,进行罗差修正。对基于椭圆假设原点修正后的X、Y轴采样数据,采用基于最小二乘24位置罗差补偿法,样机运行一周得到最终航向角的误差如图3所示。
由图2、3可知,经过基于椭圆假设原点校正后的航向角误差可控制在±3°以内,在此基础上对校正后的X轴、Y轴采样数据,采用基于最小二乘24位置罗差补偿法,航向角误差可稳定在±0.6°,可见该误差补偿方法效果较好,同时因该方法利用的是现场的采样数据,实时性也较好。
结语
本设计的电子罗盘样机采用三轴磁阻传感器HMC1043和MEMS加速度计ADXL203研制而成,系统成本低,体积小,功耗低。利用地球磁场测量航向,易受外界磁场干扰,结合经典的椭圆假设法和基于最小二乘24位置罗差补偿法,提出一种新的补偿方法对误差进行修正。实验证明,该误差补偿算法在不用额外增加硬件复杂度和软件计算量的前提下,能有效地将航向角误差稳定在±0.6°,补偿效果良好,精度较高。需要指出的是,该补偿算法的误差补偿结果是在水平状态下得出的,当俯仰角或翻滚角较大时,修正后的航向角误差会增大,如何更好地解决这一问题是今后工作的方向。
上一篇:MSP430内部看门狗及复位电路的研究
下一篇:基于MSP430单片机和CH376USB接口的信号采集存储系统
推荐阅读最新更新时间:2024-11-09 17:23
设计资源 培训 开发板 精华推荐
- LTC1565 新型连续时间低通滤波器具有差分 I/O、线性相位和宽动态范围
- 使用具有 B 类 EMI 滤波(单输出)的 RP10-2405SA DC/DC 转换器的典型应用
- 驱动 LTC1604 16 位 ADC 的 0.1dB、5 阶、22kHz 切比雪夫低通滤波器
- 使用 LTC3637MPDHC 36.5V 至 76V 输入至 36V 输出、1A 降压型稳压器的典型应用
- 电动车控制板量产原理图PCB
- 使用 Analog Devices 的 LT1578IS8-2.5 的参考设计
- 使用具有 PowerPath 和 2A 输入限制的 LTC4162EUFD-L41 9V 至 35V、2 节、3.2A 充电器的典型应用
- 使用 LTC4162IUFD-L41M 1-8 节、3.2A 降压型开关电池充电器和 PowerPath 的典型应用
- TWRPI-MPL115A: Tower System Digital Barometer Plug-In
- TP4055充电板