基于MEMS傳感器和VLC定位融合的雙卡爾曼濾波導航裝置和方法
本發明公開了一種基于MEMS傳感器和VLC定位融合的雙卡爾曼濾波導航裝置和方法,包括MEMS傳感器、INS模塊、PDR定位模塊、VLC定位模塊以及測姿定位雙卡爾曼濾波器;對于測姿濾波器,基于慣導機械編排的誤差方程作為系統方程,觀測方程包括加速度計觀測量更新和磁力計觀測量更新,輸出姿態信息給VLC定位模塊和PDR定位模塊以校正姿態的影響。對于定位濾波器,二維平面的位置信息作為系統狀態向量,基于行人航位推算的誤差方程作為系統方程,而VLC的定位結果為觀測方程。本發明的技術方案解決VLC定位容易受設備姿態影響以及在光信號被遮擋情況下定位不連續的問題,消除姿態對VLC定位的影響。
東南大學
2021-04-11