基于MEMS传感器和VLC定位融合的双粒子滤波导航装置和方法

电子信息

本发明公开了一种基于MEMS传感器和VLC定位融合的双粒子滤波导航装置和方法，包括MEMS传感器、INS模块、PDR定位模块、VLC定位模块、测姿粒子滤波器和定位粒子滤波器；本发明在测姿滤波器的设计中，三维姿态误差和三轴陀螺仪漂移作为6维的状态向量。基于惯导机械编排的误差方程作为其系统方程，用于更新粒子状态。观测方程包括加速度计观测量更新和磁力计观测量更新，用于计算粒子权重。测姿滤波器输出VLC接收器的姿态给VLC定位模块以校正姿态的影响。在定位滤波器的设计中，二维平面的位置信息作为系统状态向量，基于行人航位推算的误差方程作为系统方程，而VLC的定位结果则作为定位滤波器的观测方程。

小批量或小范围应用