基于MEMS傳感器和VLC定位融合的雙卡爾曼濾波導(dǎo)航裝置和方法

電子信息

本發(fā)明公開了一種基于MEMS傳感器和VLC定位融合的雙卡爾曼濾波導(dǎo)航裝置和方法，包括MEMS傳感器、INS模塊、PDR定位模塊、VLC定位模塊以及測姿定位雙卡爾曼濾波器；對于測姿濾波器，基于慣導(dǎo)機(jī)械編排的誤差方程作為系統(tǒng)方程，觀測方程包括加速度計(jì)觀測量更新和磁力計(jì)觀測量更新，輸出姿態(tài)信息給VLC定位模塊和PDR定位模塊以校正姿態(tài)的影響。對于定位濾波器，二維平面的位置信息作為系統(tǒng)狀態(tài)向量，基于行人航位推算的誤差方程作為系統(tǒng)方程，而VLC的定位結(jié)果為觀測方程。本發(fā)明的技術(shù)方案解決VLC定位容易受設(shè)備姿態(tài)影響以及在光信號被遮擋情況下定位不連續(xù)的問題，消除姿態(tài)對VLC定位的影響。

產(chǎn)業(yè)化應(yīng)用