电子罗盘的方位角计算公式

BY 电子罗盘的方位角计算公式

丙寅电子

Honeywell 在中国区的特级代理。

上海丙寅电子有限公司是美国霍尼韦尔提供软硬件全套解决方案，如需要任何设计与技术方面的支的项目支持经验。

在磁阻传感器应用领域有丰富

上海丙寅电子有限公司

电话：８６　０２１　６５０７２６７５

传真：８６　０２１　６５０７５８７８

地址：中国　上海市虹口区四平路１８８号上海商贸大厦８０１室

公司主页：ｈｔｔｐ：／／ｗｗｗ．ｂｉｎｇｙｉｎｄｚ．ｃｏｍ

邮箱：ｂｙ０７＠ａｎｏｔｒｏｎ．ｃｏｍ

持可与我们联系，将助您在最短的时间内设计成功。

如何得到罗盘的方位角

磁阻传感器为建立罗盘导航系统提供了固态有效的解决办法！但是我们怎么才能够从简单的3轴数据得到罗盘的方位角呢？下面就将一步步告诉你如何去实现！1）当3轴磁力计工作时可以读到XYZ 三轴的磁场强度，此时的数值并不能直接用作方位角的计算！因为此时的读数可能受到器件版面上其他一些含磁材料的影响，形成圆心坐标的硬铁漂移！

用作方位角计算的XYZ 数值必须将此漂移值移除，使圆心回到原点。

上海丙寅电子上

海丙寅电子上海丙寅电子上海丙寅电子上

海丙寅电子上

海丙寅电子丙寅电子寅电子寅电

具体的办法是：1，水平匀速旋转，收集XY 轴的数据

2，转动器材90度（此时Z 轴水平）匀速旋转以收集Z 轴数据

3，将读取到的各轴数据的最大值加上最小值除以2，就得到一个各轴的offset 值

Xoffset=（Xmax+Xmin ）/2

Yoffset=（Ymax+Ymin ）/2

Zoffset=（Zmax+Zmin ）/24，然后将磁力计读取的各轴的裸值减去前面计算所得的offset 值，就可以得到用作角度计算的Heading 值

X H =X 裸-Xoffset Y H =Y 裸-Yoffset Z H =Z 裸-Zoffset 如果只用作水平测量，则此时的方位角为

方位角=arctanY H /X H 上海丙寅电子

上海丙寅电子

上海丙寅电子

上海丙寅电子上

海丙寅电子上海丙寅电子海丙寅电子海丙寅电子

海丙寅电子

如果在测量时，我们的器件不是处在水平位置，套用以上公式，罗盘的方位角将出现偏差，此时就需要使用加速度传感器对磁力计进行倾角补偿。要对电子罗盘进行倾角的补偿，首先要计算出横滚角（θ）Roll 以及俯仰角（φ）Pitch

代入以下公式,计算Heading 值

Xh=X*cos(φ)+Y*sin(θ)*sin(φ)-Z*cos(θ)*sin(φ)

Yh=Y*cos(θ)+Z*sin(θ)

考虑到角度的4个象限，航向角的计算公式可变为以下公式

for(Xh<0)=180-[arctan(Yh/Xh)*180/π]for(Xh>0,Yh<0)=-[arctan(Yh/Xh)*180/π]

for(Xh>0,Yh>0)=360-arctan(Yh/Xh)*180/π

for(Xh=0,Yh<0)=90πfor(Xh=0,Yh>0)=270上海丙寅电子

上

海丙寅电子上

海丙寅电上海丙寅电子上海丙寅电子上海丙寅电丙寅电子寅电子寅电子