本发明公开了一种基于MEMS传感器和VLC定位融合的单粒子滤波导航装置和方法,包括MEMS传感器、INS模块、VLC定位模块、PDR定位模块和测姿定位单粒子滤波器模块;本发明中基于INS惯导机械编排的误差方程作为融合滤波器的系统方程,用于对粒子群的粒子进行更新。观测方程包括VLC定位信息更新、PDR定位信息更新和磁力计观测量更新,用于计算各个粒子的权重。输出姿态信息给VLC定位模块和PDR定位模块。本发明首次在VLC定位领域使用融合测姿准确估计VLC接收器的姿态信息,解决VLC定位容易受接收器姿态影响以及在光信号被遮挡情况下定位不连续的问题,并消除姿态对VLC定位的影响。
扫码关注,查看更多科技成果