一种电子罗盘的电路设计
- 1、下载文档前请自行甄别文档内容的完整性,平台不提供额外的编辑、内容补充、找答案等附加服务。
- 2、"仅部分预览"的文档,不可在线预览部分如存在完整性等问题,可反馈申请退款(可完整预览的文档不适用该条件!)。
- 3、如文档侵犯您的权益,请联系客服反馈,我们会尽快为您处理(人工客服工作时间:9:00-18:30)。
一种电子罗盘的电路设计
姚丽青;杨文杰
【摘要】Using the magnetic resistance sensor and acceleration
sensor,based on the idea of attitude an-gles and geomagnetic filed,an electronic compass used for measuring attitude angles is designed.The hard-ware design and software flow of the electronic compass is presented.And the presentation is accurate and detailed.According to main parts of the circuit,the error sources of measurement accuracy are analyzed.U-sing the position error correction method based on the least squares, the accuracy is also corrected.%利用磁阻传感器和加速度传感器设计
了测定姿态角的电子罗盘,给出了电子罗盘的硬件设计和软件流程,电路具体准确。
根据其构成的主要器件,分析了影响电子罗盘测量精度的误差来源,并采用基于最小二乘法位置罗差补偿法做了校正。
【期刊名称】《湖北民族学院学报(自然科学版)》
【年(卷),期】2014(000)004
【总页数】4页(P463-466)
【关键词】姿态角;电子罗盘;磁阻传感器;加速度传感器;误差校正
【作者】姚丽青;杨文杰
【作者单位】山西大学物理电子工程学院,山西太原030013;山西大学物理电子
工程学院,山西太原030013
【正文语种】中文
【中图分类】TP212.13
基于磁阻传感器和加速度传感器的电子罗盘具有体积小、重量轻、精度高、可靠性强、响应速度快等优点[1],被广泛应用于航空、航海、交通、电子通讯等领域,也应用于智能手机等生活类电子产品中.具体可以配合车载GPS 导航(GPS 进入
隧道或速度低于20km/h 就会失效)、电信基站天线角度的测量、大型机械平台的水平测量、手机、游戏杆等产品中.本设计中的电子罗盘采用Honeywell 公司的两轴磁阻传感器HMC1052L(x,y),单轴磁阻传感器HMC1021Z 以及MEMS 重力加速度传感器MXD2020E,采用MSP430F247 单片机采集处理传感器信号,
经过数据预处理和算法补偿后,罗盘系统精度基本上可以达到± 1°.该罗盘结构
简单、体积小、重量轻,已经被用到电信基站天线角度监测,实验证明,该系统有很好的推广和利用价值.本文中的电子罗盘固定在载体上,通过自身的加速度传感器和磁阻传感器分别测量出重力加速度在载体坐标系中的两个分量与地磁场的磁感应强度在载体坐标系中的分量,通过CPU 的处理确定出载体的具体方位,载体与水平地面间的夹角.
1 电子罗盘的基本原理
1.1 坐标系统
地球的磁场强度为0.5~0.6 gauss,无论何地,磁场的水平分量永远指向磁北,这是所有磁罗盘的制作基础[2].传统的导航定位,通过3 个角度,即方位角α、俯仰角θ 和横滚角φ 定义了姿态参数,实际上就是载体坐标系和地理坐标系之间
的方位关系.现在取两个坐标系OXYZ 与O 'X'Y'Z',OXYZ 为地理坐标系,OX
在当地水平面内指向地理北极,OY 在水平面内与OX 垂直在OX 右方,OZ 与
OX、OY 构成右螺旋关系,即沿重力加速度方向.方位角α 定义为沿Z 轴方向看去OXY 绕Z 轴顺时针旋转的角度为正,俯仰角θ 定义为沿Y轴方向看去OZX 绕Y 轴顺时针旋转的角度为正,横滚角φ 定义为沿X 轴方向看去OYZ 绕X 轴顺时针旋转的角度为正.O'X'Y'Z'固定在载体上,以载体质心为原点,平面直角坐标系O'X'Y'固定在载体的对称平面上,
O'Z'沿由O'X'至O'Y'的右螺旋前进方向.坐标系OXYZ 先绕Y 轴转过θ,再绕X 轴旋转φ 与坐标系O'X'Y'Z'重合.要了解载体在空间的姿态,就必须测出方位角α、俯仰角θ 和横滚角φ.
1.2 各各角度的测量原理
加速度矢量在坐标系OXYZ 中表示为[0 0 g]T,在坐标系O'X'Y'Z'中为[g'x g'y g'z]T,根据坐标系O'X'Y'Z'、OXYZ 之间的变换关系,它们的关系为:
即:
由式(2)有:和由装在载体上的加速度传感器测出,将它们代入式(3)可求出俯仰角和横滚角.
磁感应强度矢量在坐标系OXYZ 中表示为,在坐标系O'X'Y'Z'中为中三个量由磁阻传感器测出,根据坐标系OXYZ、O'X'Y'Z'之间的变换关系,它们之间的关系为:
由式(4)求得
方位角α=arctan Hx/Hy,至此载体在空间的方位由它的方位角α、俯仰角θ 和横滚角φ 完全确定.
由式(2)可知载体平面法矢量为而地平面法矢量为它们的坐标基不同,将地平面坐
标法矢量转换到载体坐标系中那么载体平面与地平面的夹角,则
γ=arccos(cosφcosθ).
2 电子罗盘系统
电子罗盘的硬件原理框图如图1 所示.本系统选用MXD2020两轴重力加速度传感器Honeywell 公司的两轴磁阻传感器HMC1052L(x,y),单轴磁阻传感器HMC1021Z,分别获得载体平面的重力加速度分量和三维空间的地磁场分量,采用MSP430F247 单片机采集处理传感器信号,经过数据预处理和算法补偿后,测得载体的姿态参数并通过Rs485 传入上位机.
2.1 微处理器
微处理器的原理图见图2,该系统采用TI 公司的16 位RISC 结构超低功耗单片机MSP430F247 作微处理器,本处理器拥有超低功耗,片上资源丰富,拥有60 KB Flash ROM,4kB RAM,32 路通用I/O 口,8 路12-Bit A/D 转换器,10 个可捕获比较的定时计数器,两个异步通用串行口,JTAG 调试口,等外围电路,便于开发和二次开发[2-3].
2.2 加速度传感器模块设计
图1 电子罗盘系统框图Fig.1 Electronic compass system block diagram
由原理分析可知,加速度传感器只需要X,Y 两轴便可,本设计选用
MXD2020.MXD2020 所测重力加速度与Dout 输出的脉冲占空比成正比,且加速度为0 时占空比为0.5,量程因子为0.2/g[4].用MSP430F247 的TA0 测量X 轴的占空比,TA1 测量Y 轴的占空比,gx=(T1x/T2x-
0.5)g/0.2=g sinθ,gy=(T1y/T2y-0.5)g/0.2=gsinφ.由此可知:
每次测量开始,设为上升沿中断,时钟源1 μs,第一次中断打开计时器,并改为下降沿中断,第二次中断再改为上升沿中断,同时捕获脉冲“ON”计时值T1,
第三次中断中捕获T2 计时值,并关闭中断.T1,T2 测得,代入式(6)可求得角θ,φ,与水平面真夹角.
2.3 磁阻传感器设计
用MSP430F247 的A0,A1,A2 对Hx',Hy',Hz'轴的磁场分量做A/D 转换,Avcc 接3.3 v 并选为Verf A/D 参考电压,精密三运放AD623 作为磁阻传感器信号放大,为区分磁场极性用一片AD623 做一精密二分压电路,将3.3v 分为1.65v 作为磁阻传感器信号放大器AD623 的参考电压 Vref. HMC1052,HMC1051 的敏感电压(sensitivity)为1.2(max)mV/V/gauss 桥路偏置电压bridge offset 为1.25 mV/V,名义电压设为0.135 mV/V 则HMC1052 ,1051 的最大输出电压为1.335×5×0.625+(1.25+0.135)×5=10.425 mV,取整为10 mV,增益Gain=1.65/0.01=165,Rg=637[5],IRF7509 组成“H”桥路对磁阻阻传感器置位/复位电路,假设置位后测得值为Mset(x,y,z),复位后测得值为Mres(x,y,z),实际磁场值为H(x,y,z)则offset(x,y,
z)=Mset(x,y,z)+Mres(x,y,z)-4096,H(x,y,z)=Mset(x,y,z)-
offset(x,y,z)-2048.Hx,Hy,Hz,φ,θ 前已求得,自然可求得航向角[4].
图2 微处理器原理图Fig.2 The principle diagram of the microprocessor
图3 加速度传感器原理图Fig.3 The principle diagram of the acceleration sensor
当(Hx<0)时,航向角α=π-arcTan(Hx/Hy);当(H>0,Hy<0)时,航向角α=-arcTan(Hx/Hy);
当(Hx>0,Hy>0)时,航向角α=2π-arcTan(Hx/Hy);
当(Hx=0,Hy<0)时,航向角α=π/2;当(Hx=0,Hy>0)时,航向角α=3π/2.
图4 X、Y 轴磁场分量测量电路Fig.4 X,Y axis magnetic field component
measurement circuit
图5 Z 轴磁场分量测量电路Fig.5 The Z axis magnetic field component measurement circuit
3 误差补偿
图6 为用MATLAB 求得的误差拟合函数,其中* 为航向角误差值,曲线为拟合函数曲线,由图可知除130°与180°误差在1 度左右外,其它角度误差拟合函数相当好,f(α)=a+bsinα+ccosα+dsin2α+ecos2α(因为误码差与实测航向角的函数关
系具有周期性,所以可设该函数为富里叶级数前5 项,由MATLAB 可求得a,b,c,d,e 系数)
图6 航向角误差拟合函数图Fig.6 Course angle error of fitting function diagram
4 结语
基于Honeywell 公司生产的磁阻传感器芯片研制的电子罗盘系统抗干扰能力强、抗震性高、稳定性好;同时硬件价格低廉、成本低、功耗小.采用的基于最小二乘
法位置罗差补偿法是罗盘误差补偿方法中的一种,该方法相比较神经网络误差补偿方法、椭圆拟合误差补偿方法来说,有较高的测量精度,只要计算出系统的误差补偿函数系数,罗盘系统即可实现误差补偿校正,操作简单、易于实现.实验证明该电子罗盘系统可应用在普通导航领域.
参考文献:
[1]刘敬彪,郑玉冰,章雪挺.三轴磁罗盘的设计与误差校正[J].自动化仪表,2008(9):10-12.
[2]袁信,俞济祥,陈哲.导航系统[M].北京:航空工业出版社,1993:2-
2.
[3] Honeywell Application Note:AN205l[EB/OL].(2007-10-08)[2014-07-01].www.magneticsensors.com.
[4] Michael J.Caruso Applications of Magneto Resistive Sensors in Navigation System[J].Sensors and Act uators,1997,21:357-342.。