[发明专利]单目视觉信息和轮速信息融合的定位方法及系统

摘要

本发明实施例提供一种单目视觉信息和轮速信息融合的定位方法及系统，该方法包括：在滑窗操作中，将窗口中最老帧从窗口中滑出，作为优化结果；将最新帧加入滑窗，以计算所述最新帧对应轮速累计的轮速信息及其协方差；将所述轮速信息和所述协方差加入到滑窗优化器中，为视觉约束提供尺度约束。本发明实施例能解决车辆单目视觉和轮速融合定位中减小参数漂移的问题，且场景依赖较小，传感器简单，不需要特定的初始化条件，普遍适用于车辆能够正常运行的场景，特别是GPS信号不良，视觉信息丰富的城市道路场景。