技術(shù)編號(hào):6223138
提示:您尚未登錄,請(qǐng)點(diǎn) 登 陸 后下載,如果您還沒有賬戶請(qǐng)點(diǎn) 注 冊(cè) ,登陸完成后,請(qǐng)刷新本頁(yè)查看技術(shù)詳細(xì)信息。本發(fā)明提出一種采用加速收斂算法的定位方法,包括以下步驟獲取加速度和地磁力的初始三維數(shù)值,計(jì)算出姿態(tài)四元數(shù)的初始值QA;獲取角速度的三維數(shù)值,計(jì)算出姿態(tài)四元數(shù)的預(yù)測(cè)值QB=QA+dQ/dt;獲取加速度和地磁力的當(dāng)前三維數(shù)值,計(jì)算出姿態(tài)參數(shù),所述姿態(tài)參數(shù)為羅德里格參數(shù)、方向余弦和歐拉角中的至少一種;通過相關(guān)的計(jì)算方法將計(jì)算得出的姿態(tài)參數(shù)轉(zhuǎn)換為姿態(tài)四元數(shù)的觀測(cè)值QD;對(duì)QD和QB進(jìn)行融合計(jì)算,得到姿態(tài)四元數(shù)的融合值QE;再次獲取角速度的三維數(shù)值,計(jì)算四元數(shù)的下一...
注意:該技術(shù)已申請(qǐng)專利,請(qǐng)尊重研發(fā)人員的辛勤研發(fā)付出,在未取得專利權(quán)人授權(quán)前,僅供技術(shù)研究參考不得用于商業(yè)用途。
該專利適合技術(shù)人員進(jìn)行技術(shù)研發(fā)參考以及查看自身技術(shù)是否侵權(quán),增加技術(shù)思路,做技術(shù)知識(shí)儲(chǔ)備,不適合論文引用。