基于MEMS傳感器和VLC定位融合的雙粒子濾波導(dǎo)航裝置和方法
本發(fā)明公開了一種基于MEMS傳感器和VLC定位融合的雙粒子濾波導(dǎo)航裝置和方法,包括MEMS傳感器、INS模塊、PDR定位模塊、VLC定位模塊、測(cè)姿粒子濾波器和定位粒子濾波器;本發(fā)明在測(cè)姿濾波器的設(shè)計(jì)中,三維姿態(tài)誤差和三軸陀螺儀漂移作為6維的狀態(tài)向量。基于慣導(dǎo)機(jī)械編排的誤差方程作為其系統(tǒng)方程,用于更新粒子狀態(tài)。觀測(cè)方程包括加速度計(jì)觀測(cè)量更新和磁力計(jì)觀測(cè)量更新,用于計(jì)算粒子權(quán)重。測(cè)姿濾波器輸出VLC接收器的姿態(tài)給VLC定位模塊以校正姿態(tài)的影響。在定位濾波器的設(shè)計(jì)中,二維平面的位置信息作為系統(tǒng)狀態(tài)向量,基于行人航位推算的誤差方程作為系統(tǒng)方程,而VLC的定位結(jié)果則作為定位濾波器的觀測(cè)方程。
東南大學(xué)
2021-04-11