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