基于滤波与优化结合的车道线分段建模及跟踪方法

本发明涉及一种基于滤波与优化结合的车道线分段建模及跟踪处理的方法，包括：根据上一帧车道线更新点集，结合当前自车的里程计信息，将上一帧的车道线更新点集变换到当前帧自车坐标系下得到预测点集；将车道线预测点集与当前帧车道线的检测点集进行关联；基于关联结果进行车道线航迹管理并计算车道线的始末端点；基于车道线航迹的始末端点，进行车道线分段建模；构建优化问题进行求解；基于优化结果，计算每条车道线的更新点集及对应方差。本发明还涉及一种相应的装置、处理器及其存储介质。采用了本发明的该方法、装置、处理器及其存储介质，在保证跟踪稳定性的同时，有效避免了对历史多帧数据的存储和维护，提高了算法的效率和实时性。