[发明专利]一种基于数据插值的多传感器异步数据融合方法

摘要

本发明公开了一种基于数据插值的多传感器异步数据融合处理方法，设计了包括航迹推算模块、数据缓冲模块、时间索引模块、数据插值模块四部分的定位框架。航迹推算模块根据车辆的运动动模型进行位姿估计。传感器获取了测量信息后经由数据缓冲模块进行缓存。通过时间索引模块来实现多传感器测量信息时间戳的精准匹配，通过数据插值模块，经由状态估计器，获得尽可能精确的车辆位置信息。通过搭建无人驾驶仿真平台验证本方法的有效性。实验结果表明，按照本发明提出的定位框架实现的定位算法具有精度高的优点。