基于誤差四元數(shù)卡爾曼濾波的行人定位算法研究.pdf

1、誤差校正是行人定位算法的重要組成部分。本文以行人慣性導(dǎo)航系統(tǒng)的各項(xiàng)導(dǎo)航參數(shù)誤差作為研究對(duì)象，以導(dǎo)航參數(shù)誤差模型為出發(fā)點(diǎn)，運(yùn)用相關(guān)數(shù)學(xué)理論、慣性導(dǎo)航基本原理，綜合行人運(yùn)動(dòng)的特點(diǎn)以及信息融合方法，推導(dǎo)出主要導(dǎo)航參數(shù)誤差之間的關(guān)聯(lián)模型。根據(jù)誤差關(guān)聯(lián)表達(dá)式進(jìn)行組合，設(shè)計(jì)了以四元數(shù)誤差、角速度誤差、位移誤差、速度誤差、加速度誤差和地磁強(qiáng)度誤差為狀態(tài)變量的卡爾曼濾波器。
　　其次，對(duì)比力模值與滑動(dòng)方差的傳統(tǒng)靜止檢測(cè)算法進(jìn)行分析，從比力方程和滑

2、動(dòng)方差的定義出發(fā)，分別建立了比力模值、滑動(dòng)方差與外部加速度之間關(guān)系的數(shù)學(xué)模型，研究了傳統(tǒng)靜止檢測(cè)算法在不同步態(tài)情況下存在失效的可能性。在此基礎(chǔ)上，本文以陀螺儀誤差模型和加速度計(jì)誤差模型為理論基礎(chǔ)，分別建立了角速度與外部加速度關(guān)聯(lián)的數(shù)學(xué)模型，設(shè)計(jì)了能夠根據(jù)行人運(yùn)動(dòng)狀態(tài)自適應(yīng)調(diào)整的新型靜止檢測(cè)算法，該算法具有結(jié)構(gòu)簡(jiǎn)單、可靠性高等特點(diǎn)。
　　最后，論文以誤差卡爾曼濾波和新型靜止檢測(cè)算法為核心，設(shè)計(jì)了行人慣導(dǎo)系統(tǒng)定位算法，實(shí)現(xiàn)對(duì)各項(xiàng)導(dǎo)航參