[发明专利]自动驾驶车辆路径规划方法、装置、车辆及存储介质在审
申请号: | 201910721183.9 | 申请日: | 2019-08-06 |
公开(公告)号: | CN110763246A | 公开(公告)日: | 2020-02-07 |
发明(设计)人: | 刘洋;宋林桓;孙连明 | 申请(专利权)人: | 中国第一汽车股份有限公司 |
主分类号: | G01C21/34 | 分类号: | G01C21/34;G05D1/02 |
代理公司: | 11659 北京远智汇知识产权代理有限公司 | 代理人: | 张海英 |
地址: | 130011 吉林省长春市*** | 国省代码: | 吉林;22 |
权利要求书: | 查看更多 | 说明书: | 查看更多 |
摘要: | |||
搜索关键词: | 目标路口 前视摄像头 车道位置 导航信息 目标车道 变道 车辆路径规划 车辆行驶 存储介质 可移植性 映射关系 预设距离 预先获取 自动驾驶 车道线 路牌 转弯 | ||
1.一种自动驾驶车辆路径规划方法,其特征在于,包括:
当确定车辆与预先获取的道路级导航信息中的目标路口的距离在预设距离范围内时,通过前视摄像头获取所述车辆在当前道路中的车道位置;
根据所述道路级导航信息中与所述目标路口对应的转弯信息以及所述车辆在当前道路中的车道位置,确定所述车辆是否需要变道;
当确定所述车辆需要变道时,根据所述车辆与各车道线的映射关系,控制所述车辆行驶到目标车道;
根据所述目标路口对应的目标路牌与所述目标路口的距离以及通过所述前视摄像头确定的所述车辆与所述目标路口的距离,确定从所述目标车道驶入所述目标路口的路径。
2.根据权利要求1所述的方法,其特征在于,所述当确定车辆与预先获取的道路级导航信息中的目标路口的距离在预设距离范围内时,通过前视摄像头获取所述车辆在当前道路中的车道位置之前,所述方法还包括:
通过车载导航系统获取所述道路级导航信息;或者,
通过控制设备获取所述道路级导航信息。
3.根据权利要求1或2所述的方法,其特征在于,所述通过前视摄像头获取所述车辆在当前道路中的车道位置,包括:
通过所述前视摄像头获取所述车辆的前方环境图像;
对所述前方环境图像进行识别,确定所述车辆在所述当前道路中的车道位置。
4.根据权利要求1或2所述的方法,其特征在于,所述车辆与车道线的映射关系为:y=C3*x3+C2*x2+C1*x+C0,其中,C3、C2、C1以及C0均为预设参数,x表示前视摄像头坐标系中所述车辆的当前位置与车辆在X轴向前的目标位置之间的距离,y表示所述前视摄像头坐标系中所述车道线与所述目标位置的距离,所述前视摄像头坐标系的原点为所述前视摄像头的位置,X轴正方向为所述车辆的前进方向,Y轴正方向为垂直于所述X轴向右的方向。
5.根据权利要求4所述的方法,其特征在于,当确定所述车辆需要变道时,根据所述车辆与各车道线的映射关系,控制所述车辆行驶到目标车道,包括:
根据所述车辆与目标车道的两条目标车道线的映射关系,确定各目标车道线与目标位置的距离;
将所述各目标车道线与目标位置的距离的和的平均值作为所述车辆在所述目标车道的最佳位置;
控制所述车辆行驶到所述最佳位置。
6.根据权利要求1或2所述的方法,其特征在于,所述当确定车辆与预先获取的道路级导航信息中的目标路口的距离在预设距离范围内时,通过前视摄像头获取所述车辆在当前道路中的车道位置之前,所述方法还包括:
通过车载导航系统获取所述车辆与所述目标路口的距离;或者,
通过车载导航系统以及所述前视摄像头获取的路牌信息,确定所述车辆与所述目标路口的距离。
7.一种自动驾驶车辆路径规划装置,其特征在于,包括:
第一获取模块,用于当确定车辆与预先获取的道路级导航信息中的目标路口的距离在预设距离范围内时,通过前视摄像头获取所述车辆在当前道路中的车道位置;
第一确定模块,用于根据所述道路级导航信息中与所述目标路口对应的转弯信息以及所述车辆在当前道路中的车道位置,确定所述车辆是否需要变道;
控制模块,用于当确定所述车辆需要变道时,根据所述车辆与各车道线的映射关系,控制所述车辆行驶到目标车道;
第二确定模块,用于根据所述目标路口对应的目标路牌与所述目标路口的距离以及通过所述前视摄像头确定的所述车辆与所述目标路口的距离,确定从所述目标车道驶入所述目标路口的路径。
8.根据权利要求7所述的装置,其特征在于,所述装置还包括第二获取模块;
所述第二获取模块,用于通过车载导航系统获取所述道路级导航信息;或者,
所述第二获取模块,用于通过控制设备获取所述道路级导航信息。
该专利技术资料仅供研究查看技术是否侵权等信息,商用须获得专利权人授权。该专利全部权利属于中国第一汽车股份有限公司,未经中国第一汽车股份有限公司许可,擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作,请联系【客服】
本文链接:http://www.vipzhuanli.com/pat/books/201910721183.9/1.html,转载请声明来源钻瓜专利网。