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