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