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