陀螺儀輔助定位方法

基本信息

申請(qǐng)?zhí)?/td> CN201310607804.3 申請(qǐng)日 -
公開(kāi)（公告）號(hào) CN103644911A 公開(kāi)（公告）日 2014-03-19
申請(qǐng)公布號(hào) CN103644911A 申請(qǐng)公布日 2014-03-19
分類(lèi)號(hào) G01C21/16(2006.01)I 分類(lèi) 測(cè)量；測(cè)試;
發(fā)明人 閆智勇;李建平 申請(qǐng)（專(zhuān)利權(quán)）人 南京北斗城際在線信息股份有限公司
代理機(jī)構(gòu) 北京市京大律師事務(wù)所 代理人 南京城際在線信息技術(shù)有限公司
地址 210006 江蘇省南京市秦淮區(qū)中山南路501號(hào)通服大廈16層
法律狀態(tài) -

摘要

摘要 本發(fā)明公開(kāi)了一種陀螺儀輔助定位方法，包括以下步驟：首先、姿態(tài)角的測(cè)量:對(duì)加速度計(jì)的測(cè)量值和磁傳感器的測(cè)量值分別經(jīng)過(guò)高斯牛頓迭代得到姿態(tài)誤差速率,陀螺儀直接通過(guò)四元數(shù)微分方程得到姿態(tài)四元數(shù)速率,兩個(gè)加起來(lái)積分得到姿態(tài)四元數(shù)；其次、初始點(diǎn)的獲?。豪眉铀俣扔?jì)和陀螺儀芯片兩者的數(shù)據(jù)，進(jìn)行軌跡推算，以將軌跡周期提高到慣性測(cè)量單元的數(shù)據(jù)周期；第三、速度和移動(dòng)距離的計(jì)算；第四、計(jì)算位置點(diǎn)；第五：糾正位置。本發(fā)明針對(duì)性的解決了陀螺儀的漂移、載體的線性加速度和周?chē)植看艌?chǎng)的干擾問(wèn)題，根據(jù)道路數(shù)據(jù)，對(duì)定位結(jié)果進(jìn)行投影修正，并利用修正結(jié)果計(jì)算下一個(gè)位置點(diǎn)，這樣就有效地減小累計(jì)誤差。