基于MEMS傳感器和VLC定位融合的單粒子濾波導(dǎo)航裝置和方法
本發(fā)明公開了一種基于MEMS傳感器和VLC定位融合的單粒子濾波導(dǎo)航裝置和方法,包括MEMS傳感器、INS模塊、VLC定位模塊、PDR定位模塊和測姿定位單粒子濾波器模塊;本發(fā)明中基于INS慣導(dǎo)機(jī)械編排的誤差方程作為融合濾波器的系統(tǒng)方程,用于對粒子群的粒子進(jìn)行更新。觀測方程包括VLC定位信息更新、PDR定位信息更新和磁力計(jì)觀測量更新,用于計(jì)算各個(gè)粒子的權(quán)重。輸出姿態(tài)信息給VLC定位模塊和PDR定位模塊。本發(fā)明首次在VLC定位領(lǐng)域使用融合測姿準(zhǔn)確估計(jì)VLC接收器的姿態(tài)信息,解決VLC定位容易受接收器姿態(tài)影響以及在光信號(hào)被遮擋情況下定位不連續(xù)的問題,并消除姿態(tài)對VLC定位的影響。
東南大學(xué)
2021-04-11