|
|
pitch和roll角由重力加速度計(jì)可得，物體傾斜補(bǔ)償時(shí)要注意pitch（俯仰角）和roll（橫滾角）的方向，否則補(bǔ)償誤差消除不了。
如何得到羅盤的方位角
磁阻傳感器為建立羅盤導(dǎo)航系統(tǒng)提供了固態(tài)有效的解決辦法！但是我們?cè)趺床拍軌驈暮?jiǎn)單的3軸數(shù)據(jù)得到羅盤的方位角呢？
下面就將一步步告訴你如何去實(shí)現(xiàn)！
1）當(dāng) 3 軸磁力計(jì)工作時(shí)可以讀到 XYZ 三軸的磁場(chǎng)強(qiáng)度，此時(shí)的數(shù)值并不能直接用作方位角的計(jì)算！因?yàn)榇藭r(shí)的讀數(shù)可能受到器件版面上其他
一些含磁材料的影響，形成圓心坐標(biāo)的硬鐵漂移！
用作方位角計(jì)算的XYZ數(shù)值必須將此漂移值移除，使圓心回到原點(diǎn)上.
具體的辦法是：
1，水平勻速旋轉(zhuǎn)，收集 XY軸的數(shù)據(jù)
2，轉(zhuǎn)動(dòng)器材90 度（此時(shí) Z軸水平）勻速旋轉(zhuǎn)以收集 Z軸數(shù)據(jù)
3，將讀取到的各軸數(shù)據(jù)的最大值加上最小值除以2，就得到一個(gè)各軸的offset 值
Xoffset=（Xmax+Xmin）/2
Yoffset=（Ymax+Ymin）/2
Zoffset=（Zmax+Zmin）/2
4，然后將磁力計(jì)讀取的各軸的裸值減去前面計(jì)算所得的 offset值，就可以得到用作角度計(jì)算的 Heading 值
XH=X裸-Xoffset
YH=Y裸-Yoffset
ZH=Z裸-Zoffset
如果只用作水平測(cè)量，則此時(shí)的方位角為
方位角=arctanYH/XH
如果在測(cè)量時(shí)，我們的器件不是處在水平位置，套用以上公式，羅盤的方位角將出現(xiàn)偏差，此時(shí)就需要使用加速度傳感器對(duì)磁力計(jì)進(jìn)行傾角補(bǔ)償。
要對(duì)電子羅盤進(jìn)行傾角的補(bǔ)償，首先要計(jì)算出橫滾角（θ）Roll 以及俯仰角（φ）Pitch
代入以下公式, 計(jì)算 Heading 值
Xh=X*cos(φ)+Y*sin(θ)*sin(φ)-Z*cos(θ)*sin(φ)
Yh=Y*cos(θ)+Z*sin(θ)
考慮到角度的4 個(gè)象限，航向角的計(jì)算公式可變?yōu)橐韵鹿?br />
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
完整的pdf格式文檔51黑下載地址：
電子羅盤方位角計(jì)算公式.pdf
(336.86 KB, 下載次數(shù): 303)
2017-8-22 14:13 上傳
點(diǎn)擊文件名下載附件
|
評(píng)分
-
查看全部評(píng)分
|
[復(fù)制鏈接]
