本發明公開了一種基于MEMS傳感器和VLC定位融合的單粒子濾波導航裝置和方法,包括MEMS傳感器、INS模塊、VLC定位模塊、PDR定位模塊和測姿定位單粒子濾波器模塊;本發明中基于INS慣導機械編排的誤差方程作為融合濾波器的系統方程,用于對粒子群的粒子進行更新。觀測方程包括VLC定位信息更新、PDR定位信息更新和磁力計觀測量更新,用于計算各個粒子的權重。輸出姿態信息給VLC定位模塊和PDR定位模塊。本發明首次在VLC定位領域使用融合測姿準確估計VLC接收器的姿態信息,解決VLC定位容易受接收器姿態影響以及在光信號被遮擋情況下定位不連續的問題,并消除姿態對VLC定位的影響。
產業化應用
掃碼關注,查看更多科技成果