三轴磁阻电子罗盘的设计和误差补偿

发布者:liliukan最新更新时间:2021-07-07 来源: 21ic关键字:误差补偿  msp430 手机看文章 扫描二维码
随时随地手机看文章

设计了一款具有倾斜补偿功能的三轴磁阻电子罗盘,并对样机系统做了误差补偿。本系统以磁阻传感器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内部看门狗及复位电路的研究
下一篇:基于MSP430单片机和CH376USB接口的信号采集存储系统

推荐阅读最新更新时间:2024-11-09 17:23

msp430学习之软件延时函数
#define CPU_F ((double)8000000) #define delay_us(x) __delay_cycles((long)(CPU_F*(double)x/1000000.0)) #define delay_ms(x) __delay_cycles((long)(CPU_F*(double)x/1000.0)) CPU_F 为系统主时钟频率; delay_us();//微秒 delay_ms();//毫秒
[单片机]
基于MSP430F149单片机的发控时序检测系统设计
由于火箭炮发射的是简易控制火箭弹,因此其定向管与火箭弹之间的电气信号接口除了与普通无控火箭弹一样具有点火信号接口外,还另有一个32芯参数装定信号接口。在发射程序中,如果火控系统计算的火箭弹的飞行控制参数能够准确地装定至火箭弹的控制系统中,则火箭弹按照简易控制方式飞行,否则按照无控方式飞行,导致火箭弹的射击精度大大下降。为了确保火箭弹能够顺利发射以及射击的准确性,在技术阵地进行装填之前,需要对火箭炮上的点火信号线路以及参数装定线路进行严格检测,确保信号线路处于良好的工况。 对于发控系统的检测,在火箭炮配套的机电检测维修车上有发控时序检测装置,用于定性检查定向管的发控时序。该检测装置不能对检测结果进行量化处理与显示,检测时只能通过
[单片机]
基于<font color='red'>MSP430</font>F149单片机的发控时序检测系统设计
MSP430停车位感应装置设计
硬件:MSP430f5529,光电传感器,数码管(共阴极) #include msp430f5529.h /*********************************************************************** 红外光电传感器输入信号到P2.0,模拟车的信号,当用手遮挡时输入高电平, 系统检测到上升沿,进入寄存器中断,P1.0灯亮,接着在寄存器中断中使能定时器的 捕获/比较寄存器(TA0CCTL0),定时器开始计时,数码管开始滚动数字,当把手挪开后, 传感器输入低电平,系统检测到下降沿,再次进入寄存器中断,P1.0取反,灯灭,接着 禁止定时器的捕获/比较寄存器(TA0CCTL0),定时
[单片机]
<font color='red'>MSP430</font>停车位感应装置设计
基于MSP430单片机的行驶车辆检测器的设计
利用环形线圈、MSP430F1121A单片机与输出接口,组成低功耗行驶车辆检测系统,并能根据用户预先设定的灵敏度、工作方式、输出方式进行车辆检测与信号输出。 还应用软件动态刷新基准的方法提高了检测的可靠性和准确性。实验表明:该系统具有结构简单、功耗低、调节方便等优点。 引言 近年来,车辆检测器作为交通信息采集的重要前端部分,越来越受到业内人士的关注。鉴于公路交通现代化管理和城市交通现代化管理的发展需要,对于行驶车辆的动态检测技术——车辆检测器的研制在国内外均已引起较大重视。车辆检测器以机动车辆为检测目标,检测车辆的通过或存在状况,其作用是为智能交通控制系统提供足够的信息以便进行最优的控制。 目前,常用的行驶车辆检测器主
[单片机]
基于<font color='red'>MSP430</font>单片机的行驶车辆检测器的设计
MSP430F5529&LCD1602程序
代码 LCD1602.c #include msp430.h #include string.h #include LCD1602.h #define CPU_F ((double)8000000) #define delay_us(x) __delay_cycles((long)(CPU_F*(double)x/1000000.0)) #define delay_ms(x) __delay_cycles((long)(CPU_F*(double)x/1000.0)) #define DataDir P3DIR #define DataPort P3OUT #define Busy 0x80 #define
[单片机]
MSP430学习笔记-IO端口
端口控制寄存器 PxDIR 输入/输出方向寄存器 PxIN 输入寄存器 PxOUT 输出寄存器 PxSEL 引脚功能选择寄存器 PxIFG 中断标志寄存器 PxIE 中断允许寄存器 PxIES 中断触发沿控制寄存器 1 5、6、7为P1、P2特有
[单片机]
MSP430FR5969内存分配的问题
cmd文件里的具体内容我就不贴了,大家自己可以看一下。cmd文件主要由两部分构成,一个是MEMORY{};另一个是SECTIONS{} 其中MEMORY{}是定义内部所有寄存器及存储器的地址,在这里大部分内容都是厂家定义好的,一般不能修改。但是咱们今天要改的就是他,当然只能改其中允许该的地方,那就是FRAM的分配问题。根据数据手册里提供的内存分配情况(如下图)我们可以得知,59x9的内存从0x0000开始,一直到0x13FFF。对应着这个图和Cmd文件,我们可以了解内部的地址分配问题,如果做过总线扩展之类的同学肯定对这个不会陌生了,如果没有见过就需要理解一下。其实也很简单,就是对应的地址要对应上就可以了。有一些是固定好的不能变
[单片机]
基于单片机的数字频率计的设计
  本文利用前置分频器SAB6456A和高速数字分频器74HC390的分频功能,结合新型的MSP430F449单片机,给出了一种新颖的、全自动的数显测量射频频率的设计方案。      图1 信号的前端处理及分频电路   主要器件介绍   MSP430F449单片机   MSP430F449 采用16位RISC结构,具有丰富的片内外设和大容量的片内工作寄存器和存储器,性能价格比很高。它的特点包括:   · 超低的功耗:能够在1.8V~ 3.6V的电压下工作;具有工作模式(AM)和5种低功耗模式(LPM)。在低功耗模式下,CPU可以被中断唤醒,响应时间小于6ps。   · 较强的运算能力:16位的RISC结构,丰富的寻址方式;
[单片机]
基于单片机的数字频率计的设计
小广播
设计资源 培训 开发板 精华推荐

最新单片机文章
何立民专栏 单片机及嵌入式宝典

北京航空航天大学教授,20余年来致力于单片机与嵌入式系统推广工作。

换一换 更多 相关热搜器件
随便看看

 
EEWorld订阅号

 
EEWorld服务号

 
汽车开发圈

电子工程世界版权所有 京B2-20211791 京ICP备10001474号-1 电信业务审批[2006]字第258号函 京公网安备 11010802033920号 Copyright © 2005-2024 EEWORLD.com.cn, Inc. All rights reserved