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