一种基于直线检测和数字地图匹配的车辆航向角估计方法

摘要

本发明公开了一种基于直线检测和数字地图匹配的车辆航向角估计方法，结合直线检测与地图匹配，将车辆位置匹配至数字地图中的对应点，计算方位角并与车辆航向角相减得到角度差，其次运用改进的FLD直线识别算法计算该时刻图像中识别到的车道线角度，利用角度差和对应图片中车道线角度参数形成数据集输入BP神经网络参与训练，训练完成后可输入图片车道线数据预测角度差，最后结合对应车道线点的方位角，计算车辆航向角。本发明估计方向角的最大误差为1.39°，精度为0.425°。综合本发明和其他方法的估计精度结果可知，本发明中的航向角估计方法与现有的方法及普通的测量传感器相比具有一定的优势。