亚洲免费av电影一区二区三区,日韩爱爱视频,51精品视频一区二区三区,91视频爱爱,日韩欧美在线播放视频,中文字幕少妇AV,亚洲电影中文字幕,久久久久亚洲av成人网址,久久综合视频网站,国产在线不卡免费播放

        ?

        一種高精度的小型三維電子羅盤簡(jiǎn)易標(biāo)定方法

        2017-03-03 01:31:49邱秀分石文峰孫春艷申和平
        艦船電子工程 2017年2期
        關(guān)鍵詞:羅盤加速度計(jì)標(biāo)定

        邱秀分 石文峰 孫春艷 申和平

        (北京神州普惠科技股份有限公司 北京 100085)

        一種高精度的小型三維電子羅盤簡(jiǎn)易標(biāo)定方法

        邱秀分 石文峰 孫春艷 申和平

        (北京神州普惠科技股份有限公司 北京 100085)

        由于三維電子羅盤中存在多種誤差因素互相耦合,普通方法很難將其各自標(biāo)定出來(lái)并進(jìn)行補(bǔ)償,對(duì)姿態(tài)的解算造成了較大影響。論文為了解決這一問(wèn)題,設(shè)計(jì)了一種簡(jiǎn)易的標(biāo)定方法。首先通過(guò)繞軸轉(zhuǎn)動(dòng)校正傳感器各敏感軸的安裝誤差,再利用橢球擬合求取零偏和靈敏度誤差,同時(shí)考慮安裝誤差、非正交誤差、對(duì)齊誤差、硬磁效應(yīng)等因素之間的內(nèi)部關(guān)系,從整體上進(jìn)行標(biāo)定。實(shí)驗(yàn)結(jié)果表明,經(jīng)過(guò)該方法標(biāo)定后,三維電子羅盤在俯仰角±85°范圍內(nèi)的解算誤差都能夠達(dá)到±0.5以內(nèi)。

        三維電子羅盤; 磁傳感器; 誤差標(biāo)定; 姿態(tài)解算

        Class Number TN966

        1 引言

        水下導(dǎo)航中對(duì)載體姿態(tài)的精確測(cè)量與控制是提高導(dǎo)航系統(tǒng)精度的關(guān)鍵?,F(xiàn)有的一些測(cè)量姿態(tài)的方式,如電羅經(jīng),啟動(dòng)時(shí)間很長(zhǎng),磨損大且穩(wěn)定性不足,還需要大功率電源供電才能進(jìn)行工作;慣導(dǎo)系統(tǒng)雖然短時(shí)間內(nèi)測(cè)姿精度較高,但是價(jià)格昂貴,需要初始對(duì)準(zhǔn),且測(cè)量誤差隨時(shí)間累積,不易消除。磁傳感器利用地磁場(chǎng)來(lái)計(jì)算磁航向角,因其體積小、功耗低且溫度特性良好、工作穩(wěn)定、誤差不隨時(shí)間累積等優(yōu)點(diǎn),與加速度計(jì)組合而成的三維電子羅盤在水下導(dǎo)航領(lǐng)域的應(yīng)用越來(lái)越廣泛。

        三維電子羅盤中存在著零偏誤差、靈敏度誤差、非正交誤差、對(duì)齊誤差、硬磁效應(yīng)等誤差因素。這些誤差都會(huì)使傳感器的輸出偏離真實(shí)值,進(jìn)而對(duì)當(dāng)前姿態(tài)的解算造成較大影響。為了讓解算的姿態(tài)更加準(zhǔn)確,必須對(duì)這些誤差因素進(jìn)行精確的標(biāo)定和補(bǔ)償。張愛(ài)軍[1]提出一種將補(bǔ)償區(qū)間分段的方法,分區(qū)間進(jìn)行最小二乘誤差補(bǔ)償,但是只適用于小傾斜角度工作條件下的磁航向角誤差補(bǔ)償。陳池來(lái)[2]研究了一種弱磁方向傳感器的標(biāo)定方法,改變某一敏感軸初始時(shí)與地磁場(chǎng)矢量夾角,測(cè)得多組繞轉(zhuǎn)臺(tái)一周的敏感軸輸出的極小值與中點(diǎn)值,進(jìn)行誤差的標(biāo)定,但是其只考慮了磁傳感器自身的誤差,未從整體上對(duì)三維電子羅盤的所有誤差進(jìn)行標(biāo)定。Crassidis[3]提出了基于擴(kuò)展卡爾曼濾波和無(wú)跡卡爾曼濾波的方法,對(duì)磁羅盤進(jìn)行實(shí)時(shí)校正。杜英[4]利用橢球擬合法對(duì)三軸磁傳感器誤差進(jìn)行補(bǔ)償,但是安裝誤差和硬磁效應(yīng)誤差無(wú)法較為準(zhǔn)確的進(jìn)行標(biāo)定。其他學(xué)者[5~10]也在此領(lǐng)域做了深入研究。

        目前大多數(shù)學(xué)者的研究都是著重于某一類或者某幾類誤差的標(biāo)定,很少有對(duì)三維電子羅盤整體的誤差進(jìn)行綜合標(biāo)定,且在使用時(shí)對(duì)傳感器的傾斜角度也有要求,部分只能夠在傾斜角較小時(shí)才能夠保證精度。本文同時(shí)考慮三維電子羅盤內(nèi)部傳感器三軸非正交誤差、兩類傳感器與外殼的坐標(biāo)系的對(duì)齊誤差、磁傳感器硬磁效應(yīng)等之間的相互關(guān)系,從整體上將它們都當(dāng)成一種內(nèi)部芯片與外殼體之間的安裝誤差,提出了一種新的繞外殼軸旋轉(zhuǎn)標(biāo)定安裝誤差的方法,再結(jié)合橢球擬合標(biāo)定靈敏度和零偏誤差,實(shí)現(xiàn)了三維電子羅盤整體誤差的精確標(biāo)定與校正,且校正后傳感器在全傾斜角度范圍內(nèi)都能夠保證高精度工作。

        2 誤差標(biāo)定方法

        2.1 誤差模型

        三維電子羅盤由三軸磁傳感器和三軸加速度計(jì)組成,輸出分別是通過(guò)其敏感軸感應(yīng)地磁場(chǎng)矢量和重力矢量得到的,在工作上相互獨(dú)立,所以對(duì)它們誤差的標(biāo)定也是相對(duì)獨(dú)立的。兩種傳感器各自存在著零偏誤差、靈敏度誤差、安裝誤差、非正交誤差等,其中磁傳感器還受到硬磁效應(yīng)的影響,兩類傳感器之間存在對(duì)齊誤差。本文將這些誤差歸總為各傳感器與外殼之間的安裝誤差、零偏誤差和靈敏度誤差。以三軸磁傳感器為例,模型如下[4]:

        (1)

        將這些誤差項(xiàng)標(biāo)定完成后帶入修正實(shí)測(cè)數(shù)據(jù),就能夠得到理想的三軸磁測(cè)數(shù)據(jù):

        (2)

        2.2 誤差標(biāo)定方法

        首先對(duì)磁傳感器的安裝誤差進(jìn)行標(biāo)定。地磁場(chǎng)矢量在某一固定地點(diǎn)的方向和大小均確定且不隨時(shí)間變化。將電子羅盤繞殼體的某一軸轉(zhuǎn)動(dòng)360°,如果這個(gè)方向上磁傳感器的敏感軸與殼體的坐標(biāo)軸重合,如圖1(a)所示,那么其在旋轉(zhuǎn)過(guò)程中與地磁場(chǎng)矢量的夾角應(yīng)為一個(gè)固定角度,輸出的數(shù)值應(yīng)該基本保持不變。而如果存在安裝誤差使得磁傳感器敏感軸與殼體坐標(biāo)軸不重合,如圖1(b)所示,那么在繞殼體Z軸轉(zhuǎn)動(dòng)360°的過(guò)程中,磁傳感器敏感軸軸與地磁場(chǎng)矢量的夾角是變化的,其輸出也會(huì)發(fā)生相應(yīng)的變化。加速度計(jì)如果存在安裝誤差,如果按照類似方法進(jìn)行旋轉(zhuǎn),其敏感軸與重力矢量之間也存在同樣的變化。

        圖1 理想無(wú)安裝誤差與實(shí)際有安裝誤差旋轉(zhuǎn)示意圖

        建立安裝誤差模型,在小角度近似的條件下,安裝誤差矩陣為

        (3)

        其中,αBxy、αBxz表示傳感器X軸往Y軸和Z軸方向偏離的角度,βByx、βByz表示傳感器Y軸往X軸、Z軸偏離的角度,γBzx、γBzy表示傳感器Z軸往X軸、Y軸偏離的角度。

        當(dāng)對(duì)Z軸的傾角γBzx、γBzy進(jìn)行補(bǔ)償時(shí):

        (4)

        (5)

        得到最優(yōu)的補(bǔ)償角:

        (6)

        同理可以將X軸傾角αBxy、αBxz和Y軸傾角βByx、βByz進(jìn)行標(biāo)定和補(bǔ)償:

        (7)

        (8)

        這樣通過(guò)十分簡(jiǎn)便的方法就能將磁傳感器和加速度計(jì)的安裝誤差精確標(biāo)定得到,同時(shí)考慮了系統(tǒng)內(nèi)部許多誤差的影響,直接將傳感器坐標(biāo)系校正到與外殼坐標(biāo)系重合,使得整個(gè)誤差模型和標(biāo)校過(guò)程更加簡(jiǎn)便、準(zhǔn)確。

        3 姿態(tài)解算

        利用補(bǔ)償后的三維電子羅盤的輸出值進(jìn)行姿態(tài)解算。定義三軸加速度計(jì)補(bǔ)償后的輸出Gp與三軸磁傳感器補(bǔ)償后的輸出Bp如下:

        Bp=Rx(φ)Ry(θ)Rz(ψ)Br

        (9)

        其中Gr、Br分別為當(dāng)?shù)卣鎸?shí)加速度矢量和地磁矢量,Rx(φ)、Ry(θ)、Rz(ψ)分別為繞X、Y、Z三個(gè)軸進(jìn)行旋轉(zhuǎn)的旋轉(zhuǎn)矩陣。經(jīng)過(guò)計(jì)算得到橫滾角φ、傾斜角θ、航向角ψ分別為

        (10)

        4 實(shí)驗(yàn)驗(yàn)證

        本次試驗(yàn)采用本公司自研未標(biāo)定的三維電子羅盤,外殼尺寸為50mm*11mm*12mm。將電子羅盤外殼的三個(gè)軸分別對(duì)齊轉(zhuǎn)臺(tái)的X、Y、Z軸,首先讓轉(zhuǎn)臺(tái)分別繞X、Y、Z軸各旋轉(zhuǎn)一圈,然后將轉(zhuǎn)臺(tái)的X軸調(diào)至90°,再繞Y軸旋轉(zhuǎn)一圈,一共旋轉(zhuǎn)四圈,每隔30°記錄磁傳感器和加速度計(jì)輸出。按照文中所述的方法進(jìn)行安裝誤差、零偏誤差和靈敏度誤差進(jìn)行標(biāo)定和補(bǔ)償。

        首先校正磁傳感器和加速度計(jì)的安裝誤差,得到的結(jié)果為如表1所示。

        表1 標(biāo)定得到的最佳安裝誤差補(bǔ)償角

        將磁傳感器和加速度計(jì)每個(gè)敏感軸經(jīng)過(guò)校正后的輸出與校正前的輸出進(jìn)行對(duì)比,如圖2所示??梢园l(fā)現(xiàn),經(jīng)過(guò)校正后,旋轉(zhuǎn)一圈各敏感軸的輸出變化明顯減小,只在小范圍內(nèi)波動(dòng),可以認(rèn)為已經(jīng)較好地對(duì)安裝誤差進(jìn)行了補(bǔ)償。

        再利用橢球擬合法求得三維電子羅盤中磁傳感器和加速度計(jì)的零偏誤差和靈敏度誤差,將三類誤差綜合補(bǔ)償后,就能使三維電子羅盤的精度大大提高。

        將標(biāo)定后電子羅盤進(jìn)行精度測(cè)試實(shí)驗(yàn),結(jié)果如表2所示。

        表2 不同姿態(tài)下測(cè)試解算誤差

        可以發(fā)現(xiàn),通過(guò)校正后的傳感器輸出計(jì)算姿態(tài),橫滾角、俯仰角誤差均在±0.15°以內(nèi),航向角誤差在±0.5°以內(nèi)。在傳感器體積如此小的情況下解算的姿態(tài)角仍能夠達(dá)到較高的精度,且沒(méi)有小傾斜角度的使用條件限制,在俯仰角達(dá)85°時(shí)仍能夠正常工作。

        5 結(jié)語(yǔ)

        本文針對(duì)于當(dāng)前大多數(shù)方法都只能單獨(dú)標(biāo)校磁傳感器的誤差,而無(wú)法對(duì)電子羅盤的整體誤差進(jìn)行標(biāo)定的問(wèn)題,設(shè)計(jì)了一種新的校正安裝誤差的方法。以電子羅盤外殼坐標(biāo)系為參考系進(jìn)行統(tǒng)一標(biāo)定,標(biāo)定電子羅盤包括磁傳感器和加速度計(jì)在內(nèi)的安裝誤差、靈敏度誤差和零偏誤差,實(shí)現(xiàn)了整個(gè)三維電子羅盤的精確標(biāo)定與校正。經(jīng)過(guò)實(shí)際驗(yàn)證,標(biāo)定后的三維電子羅盤姿態(tài)測(cè)算精度,橫滾角、俯仰角誤差均在±0.15°以內(nèi),航向角誤差在±0.5°以內(nèi),且在俯仰角達(dá)85°時(shí)仍能夠正常工作,工程實(shí)用價(jià)值較高。

        [1] 張愛(ài)軍,王昌明,趙輝.三軸電子羅盤的磁航向角誤差補(bǔ)償研究[J].傳感器與微系統(tǒng),2008(8):33-35.

        [2] 陳池來(lái),朱榮華,林新華,等.一種弱磁方向傳感器的標(biāo)定方法[P].2009-11-25.

        [3] Crassidis J L, Koklam L, Harman R R. Real-time-attitude-independent three-axis magnetometer calibration[J]. Journal of Guidance Control and Dynamics,2005,28(1):115-120.

        [4] 杜英.電子羅盤測(cè)量誤差分析和補(bǔ)償技術(shù)研究[D].太原:中北大學(xué),2011.

        [5] Bergamini E, Ligorio G, Summa A. Estimating Orientation Using Magnetic and Inertial Sensors and Different Sensor Fusion Approaches: Accuracy Assessment in Manual and Locomotion Tasks[J]. Sensors,2014,14:18625-18649.

        [6] Li Q, Griffiths J G. Least Squares Ellipsoid Specific Fitting[C]//Proceedings of the Geometric Modeling and Processing 2004,2004.

        [7] 郭鵬飛,任章,邱海韜,等.一種十二位置不對(duì)北的磁羅盤標(biāo)定方法[J].中國(guó)慣性技術(shù)學(xué)報(bào),2007(5):598-601.

        [8] 鐘辰,金海紅,任騰,等.基于遺傳算法的數(shù)字羅盤誤差補(bǔ)償方法研究[J].傳感技術(shù)學(xué)報(bào),2012(6):803-806.

        [9] 徐建.鐵磁材料對(duì)地磁測(cè)量的干擾分析及其校正技術(shù)研究[D].南京:南京理工大學(xué),2013.

        [10] 周榕軍,劉大明,洪澤宏,等.非理想條件下三軸磁通門傳感器誤差修正方法[J].艦船科學(xué)技術(shù),2011(3):85-89.

        A Simplified High-Precision Calibration Method for 3D Electronic Compass

        QIU Xiufen SHI Wenfeng SUN Chunyan SHEN Heping

        (Appsoft Technology Co., Ltd, Beijing 100085)

        As multiple error factors of three-dimensional electronic compass coupled to each other, common methods are hard to calibrate and compensate the errors, which has a great influence on calculation of attitude. To solve this problem, this paper designed a simple calibration method. Firstly, the sensor dip-angle is found out by rotation, then the bias error and sensitivity error is calculated by ellipsoid-fitting. This method considers the internal relations among the installation error, nonorthogonal error, alignment error, soft magnetic effect, hard magnetic effect, treat the electronic compass as a whole. The experimental results show that using this simple calibration method, the error of attitude sensor can achieve ±0.5 degrees within the range of pitching angle of ±85 degrees.

        three-dimensional electronic compass, magnetic sensor, error calibration, posture calculating

        2016年8月3日,

        2016年9月21日

        國(guó)家重大科學(xué)儀器設(shè)備開發(fā)專項(xiàng)項(xiàng)目(編號(hào):2013YQ140431)資助。

        邱秀分,女,工程師,研究方向:水聲信號(hào)處理。石文峰,男,工程師,研究方向:水聲信號(hào)處理。孫春艷,女,工程師,研究方向:水聲信號(hào)處理。申和平,男,高級(jí)工程師,研究方向:水聲信號(hào)處理。

        TN966

        10.3969/j.issn.1672-9730.2017.02.020

        猜你喜歡
        羅盤加速度計(jì)標(biāo)定
        基于加速度計(jì)的起重機(jī)制動(dòng)下滑量測(cè)量
        使用朗仁H6 Pro標(biāo)定北汽紳寶轉(zhuǎn)向角傳感器
        基于勻速率26位置法的iIMU-FSAS光纖陀螺儀標(biāo)定
        基于遺傳算法的加速度計(jì)免轉(zhuǎn)臺(tái)標(biāo)定方法
        不宜上課
        常溫下硅微諧振加速度計(jì)零偏穩(wěn)定性的提高
        船載高精度星敏感器安裝角的標(biāo)定
        印尼《羅盤報(bào)》之中國(guó)國(guó)家形象
        新聞傳播(2015年9期)2015-07-18 11:04:12
        蒼蠅腦中有“羅盤”
        基于Harris-張正友平面標(biāo)定法的攝像機(jī)標(biāo)定算法
        av在线免费观看大全| 日韩精品夜色二区91久久久| 人妻少妇偷人精品一区二区三区| 久久精品国产99国产精品澳门| 亚洲国产日韩欧美一区二区三区| 热久久这里只有| 国产又色又爽无遮挡免费| 国产欧美日韩在线观看一区二区三区| 久久夜色精品亚洲天堂| 久久熟妇少妇亚洲精品| 台湾无码av一区二区三区| 国产精品无码无片在线观看3D| 亚洲一区二区三区麻豆| 狠狠综合亚洲综合亚洲色| 少妇高清精品毛片在线视频| 日韩AV无码一区二区三不卡| 国产精品美女主播在线| 国产精品二区一区二区aⅴ污介绍| 亚洲欧洲巨乳清纯| 国产真实伦视频在线视频| 男女做那个视频网站国产| 久久久久久亚洲av成人无码国产| 亚洲h视频| 大屁股流白浆一区二区| 亚洲综合精品亚洲国产成人| 国模欢欢炮交啪啪150| 国产精品久久国产三级国电话系列| 三个黑人插一个女的视频| 最新国产毛2卡3卡4卡| 亚洲免费观看在线视频| 丰满少妇高潮在线观看| 伊人婷婷综合缴情亚洲五月| 乱中年女人伦| 最新69国产成人精品视频免费| 亚洲国产精品午夜电影| 亚洲精品中文字幕一二| 久久久久夜夜夜精品国产| 欧美在线视频免费观看| 一本大道综合久久丝袜精品| 久久精品网站免费观看| 欧美老妇与zozoz0交|