技术特征：
技术总结
本发明公开了一种基于MEMS传感器和VLC定位融合的双粒子滤波导航装置和方法，包括MEMS传感器、INS模块、PDR定位模块、VLC定位模块、测姿扩展卡尔曼滤波器和定位扩展卡尔曼滤波器；本发明在测姿滤波器的设计中，三维姿态误差和三轴陀螺仪漂移作为6维的状态向量。基于惯导机械编排的误差方程作为其系统方程，用于更新粒子状态。观测方程包括加速度计观测量更新和磁力计观测量更新，用于计算粒子权重。测姿滤波器输出VLC接收器的姿态给VLC定位模块以校正姿态的影响。在定位滤波器的设计中，二维平面的位置信息作为系统状态向量，基于行人航位推算的误差方程作为系统方程，而VLC的定位结果则作为定位滤波器的观测方程。
技术研发人员：庄园;华鲁驰;戚隆宁
受保护的技术使用者：东南大学
技术研发日：2017.06.28
技术公布日：2017.10.20