基于MEMS传感器和VLC定位融合的单卡尔曼滤波导航装置和方法

电子信息

本发明公开了一种基于MEMS传感器和VLC定位融合的单卡尔曼滤波导航装置和方法，包括MEMS传感器、INS模块、VLC定位模块、PDR定位模块和测姿定位单卡尔曼滤波器模块；本发明基于INS惯导机械编排的误差方程作为融合滤波器的系统方程，观测方程包括VLC定位信息更新、PDR定位信息更新和磁力计观测量更新。融合滤波器输出VLC接收器的姿态给VLC定位模块，输出PDR设备的姿态给PDR定位模块以校正姿态的影响。首次在VLC定位领域使用融合测姿准确估计VLC接收器的姿态信息，主要解决了VLC定位容易受设备姿态影响以及在光信号被遮挡情况下定位不连续的问题。

产业化应用