专利名称: | 变道超车方法和装置 | ||
专利名称(英文): | Lane changing overtaking method and device | ||
专利号: | CN201510590873.7 | 申请时间: | 20150914 |
公开号: | CN105303888A | 公开时间: | 20160203 |
申请人: | 奇瑞汽车股份有限公司 | ||
申请地址: | 241006 安徽省芜湖市芜湖经济技术开发区长春路8号 | ||
发明人: | 方啸; 高红博; 王继贞; 徐达学; 杜金枝 | ||
分类号: | G08G1/16 | 主分类号: | G08G1/16 |
代理机构: | 北京三高永信知识产权代理有限责任公司 11138 | 代理人: | 吕耀萍 |
摘要: | 本发明公开了一种变道超车方法和装置,属于车辆技术领域。所述方法包括:每隔预设时长获取车辆当前的行驶速度和车轮转向角度,根据该车辆当前的行驶速度和车轮转向角度,获取该车辆当前的位置信息,根据该车辆当前的位置信息和已确定的目标位置信息,判断该车辆是否处于变道超车状态,当确定该车辆处于变道超车状态时,根据该车辆当前的位置信息和该目标位置信息,对该车辆的车轮转向角度进行调整,避免了车轮转向角度出现误差,则在车辆根据调整后的车轮转向角度行驶时,避免了出现车辆偏离车道或刮擦障碍车等问题,提高了可靠性。 | ||
摘要(英文): | The invention discloses a lane changing overtaking method and device, which belongs to the technical field of vehicles. The method comprises the steps that the current driving speed and the wheel steering angle of a vehicle are acquired every preset time length; according to the current driving speed and the wheel steering angle of the vehicle, the current position information of the vehicle is acquired; according to the current position information of the vehicle and determined target position information, whether the vehicle is in a lane changing overtaking state is determined; and if the vehicle is in a lane changing overtaking state, according to the current position information of the vehicle and the target position information, the wheel steering angle of the vehicle is adjusted. Wheel steering angle errors are avoided. When the vehicle drives at the adjusted wheel steering angle, the vehicle is prevented from deviating from a lane or scratching a barrier vehicle. The reliability is improved. |
1.一种变道超车方法,其特征在于,所述方法包括: 每隔预设时长获取车辆当前的行驶速度和车轮转向角度; 根据所述车辆当前的行驶速度和车轮转向角度,获取所述车辆当前的位置 信息,所述位置信息包括横坐标和纵坐标; 根据所述车辆当前的位置信息和已确定的目标位置信息,判断所述车辆是 否处于变道超车状态,所述目标位置信息包括目标横坐标和目标纵坐标; 当确定所述车辆处于变道超车状态时,根据所述车辆当前的位置信息和所 述目标位置信息,对所述车辆的车轮转向角度进行调整; 根据调整后的车轮转向角度行驶,直至当所述车辆未处于变道超车状态时 为止。
2.根据权利要求1所述的方法,其特征在于,所述每隔预设时长获取车辆 当前的行驶速度和车轮转向角度之前,所述方法还包括: 获取所述车辆与检测到的障碍车在车道线方向上的距离; 当确定所述距离小于预设阈值时,获取所述车辆的初始状态信息,所述初 始状态信息包括所述车辆与车道线之间的距离、所述车辆与所述障碍车在车道 线方向上的距离、所述车辆的初始行驶速度和初始车轮转向角度; 根据所述初始状态信息,获取所述车辆的目标位置信息; 根据所述初始状态信息,获取第一车轮转向角度和第二车轮转向角度。
3.根据权利要求2所述的方法,其特征在于,所述根据所述初始状态信息, 获取所述车辆的目标位置信息,包括: 根据所述初始状态信息,应用以下公式,获取所述车辆的目标位置信息: xg=Dx;
4.根据权利要求2所述的方法,其特征在于,所述根据所述初始状态信息, 获取第一车轮转向角度和第二车轮转向角度,包括: 根据所述初始状态信息,应用以下公式,获取第一车轮转向角度和第二车 轮转向角度:
5.根据权利要求1所述的方法,其特征在于,所述根据所述车辆当前的行 驶速度和车轮转向角度,获取所述车辆当前的位置信息,包括: 根据所述车辆当前的行驶速度和车轮转向角度,应用以下公式,获取所述 车辆当前的位置信息:
6.根据权利要求1所述的方法,其特征在于,所述根据所述车辆当前的位 置信息和已确定的目标位置信息,判断所述车辆是否处于变道超车状态,包括: 判断所述车辆当前的横坐标是否小于所述目标横坐标; 当所述车辆当前的横坐标小于所述目标横坐标时,确定所述车辆处于变道 超车状态; 当所述车辆当前的横坐标不小于所述目标横坐标时,确定所述车辆未处于 变道超车状态。
7.根据权利要求1所述的方法,其特征在于,所述根据所述车辆当前的位 置信息和已确定的目标位置信息,判断所述车辆是否处于变道超车状态,包括: 判断所述车辆当前的纵坐标是否小于所述目标纵坐标; 当所述车辆当前的纵坐标小于所述目标纵坐标时,确定所述车辆处于变道 超车状态; 当所述车辆当前的纵坐标不小于所述目标纵坐标时,确定所述车辆未处于 变道超车状态。
8.根据权利要求1所述的方法,其特征在于,所述当确定所述车辆处于变 道超车状态时,根据所述车辆当前的位置信息和所述目标位置信息,对所述车 辆的车轮转向角度进行调整,包括: 当确定所述车辆处于变道超车状态时,判断所述车辆当前的横坐标是否小 于所述目标横坐标的二分之一; 当所述车辆当前的横坐标小于所述目标横坐标的二分之一时,将所述车辆 的车轮转向角度调整为第一车轮转向角度; 当所述车辆当前的横坐标不小于所述目标横坐标的二分之一时,将所述车 辆的车轮转向角度调整为第二车轮转向角度。
9.根据权利要求1所述的方法,其特征在于,所述当确定所述车辆处于变 道超车状态时,根据所述车辆当前的位置信息和所述目标位置信息,对所述车 辆的车轮转向角度进行调整,包括: 当确定所述车辆处于变道超车状态时,判断所述车辆当前的纵坐标是否小 于所述目标纵坐标的二分之一; 当所述车辆当前的纵坐标小于所述目标纵坐标的二分之一时,将所述车辆 的车轮转向角度调整为第一车轮转向角度; 当所述车辆当前的纵坐标不小于所述目标纵坐标的二分之一时,将所述车 辆的车轮转向角度调整为第二车轮转向角度。
10.一种变道超车装置,其特征在于,所述装置包括: 获取模块,用于每隔预设时长获取车辆当前的行驶速度和车轮转向角度; 所述获取模块,还用于根据所述车辆当前的行驶速度和车轮转向角度,获 取所述车辆当前的位置信息,所述位置信息包括横坐标和纵坐标; 判断模块,用于根据所述车辆当前的位置信息和已确定的目标位置信息, 判断所述车辆是否处于变道超车状态,所述目标位置信息包括目标横坐标和目 标纵坐标; 调整模块,用于当确定所述车辆处于变道超车状态时,根据所述车辆当前 的位置信息和所述目标位置信息,对所述车辆的车轮转向角度进行调整; 行驶模块,用于根据调整后的车轮转向角度行驶,直至当所述车辆未处于 变道超车状态时为止。
11.根据权利要求10所述的装置,其特征在于,所述获取模块还用于获取 所述车辆与检测到的障碍车在车道线方向上的距离;当确定所述距离小于预设 阈值时,获取所述车辆的初始状态信息,所述初始状态信息包括所述车辆与车 道线之间的距离、所述车辆与所述障碍车在车道线方向上的距离、所述车辆的 初始行驶速度和初始车轮转向角度;根据所述初始状态信息,获取所述车辆的 目标位置信息;根据所述初始状态信息,获取第一车轮转向角度和第二车轮转 向角度。
12.根据权利要求11所述的装置,其特征在于,所述获取模块还用于根据 所述初始状态信息,应用以下公式,获取所述车辆的目标位置信息: xg=Dx;
13.根据权利要求11所述的装置,其特征在于,所述获取模块还用于根据 所述初始状态信息,应用以下公式,获取第一车轮转向角度和第二车轮转向角 度:
14.根据权利要求10所述的装置,其特征在于,所述获取模块还用于根据 所述车辆当前的行驶速度和车轮转向角度,应用以下公式,获取所述车辆当前 的位置信息:
15.根据权利要求10所述的装置,其特征在于,所述判断模块还用于判断 所述车辆当前的横坐标是否小于所述目标横坐标;当所述车辆当前的横坐标小 于所述目标横坐标时,确定所述车辆处于变道超车状态;当所述车辆当前的横 坐标不小于所述目标横坐标时,确定所述车辆未处于变道超车状态。
16.根据权利要求10所述的装置,其特征在于,所述判断模块还用于判断 所述车辆当前的纵坐标是否小于所述目标纵坐标;当所述车辆当前的纵坐标小 于所述目标纵坐标时,确定所述车辆处于变道超车状态;当所述车辆当前的纵 坐标不小于所述目标纵坐标时,确定所述车辆未处于变道超车状态。
17.根据权利要求10所述的装置,其特征在于,所述调整模块还用于当确 定所述车辆处于变道超车状态时,判断所述车辆当前的横坐标是否小于所述目 标横坐标的二分之一;当所述车辆当前的横坐标小于所述目标横坐标的二分之 一时,将所述车辆的车轮转向角度调整为第一车轮转向角度;当所述车辆当前 的横坐标不小于所述目标横坐标的二分之一时,将所述车辆的车轮转向角度调 整为第二车轮转向角度。
18.根据权利要求10所述的装置,其特征在于,所述调整模块还用于当确 定所述车辆处于变道超车状态时,判断所述车辆当前的纵坐标是否小于所述目 标纵坐标的二分之一;当所述车辆当前的纵坐标小于所述目标纵坐标的二分之 一时,将所述车辆的车轮转向角度调整为第一车轮转向角度;当所述车辆当前 的纵坐标不小于所述目标纵坐标的二分之一时,将所述车辆的车轮转向角度调 整为第二车轮转向角度。
1.一种变道超车方法,其特征在于,所述方法包括: 每隔预设时长获取车辆当前的行驶速度和车轮转向角度; 根据所述车辆当前的行驶速度和车轮转向角度,获取所述车辆当前的位置 信息,所述位置信息包括横坐标和纵坐标; 根据所述车辆当前的位置信息和已确定的目标位置信息,判断所述车辆是 否处于变道超车状态,所述目标位置信息包括目标横坐标和目标纵坐标; 当确定所述车辆处于变道超车状态时,根据所述车辆当前的位置信息和所 述目标位置信息,对所述车辆的车轮转向角度进行调整; 根据调整后的车轮转向角度行驶,直至当所述车辆未处于变道超车状态时 为止。
2.根据权利要求1所述的方法,其特征在于,所述每隔预设时长获取车辆 当前的行驶速度和车轮转向角度之前,所述方法还包括: 获取所述车辆与检测到的障碍车在车道线方向上的距离; 当确定所述距离小于预设阈值时,获取所述车辆的初始状态信息,所述初 始状态信息包括所述车辆与车道线之间的距离、所述车辆与所述障碍车在车道 线方向上的距离、所述车辆的初始行驶速度和初始车轮转向角度; 根据所述初始状态信息,获取所述车辆的目标位置信息; 根据所述初始状态信息,获取第一车轮转向角度和第二车轮转向角度。
3.根据权利要求2所述的方法,其特征在于,所述根据所述初始状态信息, 获取所述车辆的目标位置信息,包括: 根据所述初始状态信息,应用以下公式,获取所述车辆的目标位置信息: xg=Dx;
4.根据权利要求2所述的方法,其特征在于,所述根据所述初始状态信息, 获取第一车轮转向角度和第二车轮转向角度,包括: 根据所述初始状态信息,应用以下公式,获取第一车轮转向角度和第二车 轮转向角度:
5.根据权利要求1所述的方法,其特征在于,所述根据所述车辆当前的行 驶速度和车轮转向角度,获取所述车辆当前的位置信息,包括: 根据所述车辆当前的行驶速度和车轮转向角度,应用以下公式,获取所述 车辆当前的位置信息:
6.根据权利要求1所述的方法,其特征在于,所述根据所述车辆当前的位 置信息和已确定的目标位置信息,判断所述车辆是否处于变道超车状态,包括: 判断所述车辆当前的横坐标是否小于所述目标横坐标; 当所述车辆当前的横坐标小于所述目标横坐标时,确定所述车辆处于变道 超车状态; 当所述车辆当前的横坐标不小于所述目标横坐标时,确定所述车辆未处于 变道超车状态。
7.根据权利要求1所述的方法,其特征在于,所述根据所述车辆当前的位 置信息和已确定的目标位置信息,判断所述车辆是否处于变道超车状态,包括: 判断所述车辆当前的纵坐标是否小于所述目标纵坐标; 当所述车辆当前的纵坐标小于所述目标纵坐标时,确定所述车辆处于变道 超车状态; 当所述车辆当前的纵坐标不小于所述目标纵坐标时,确定所述车辆未处于 变道超车状态。
8.根据权利要求1所述的方法,其特征在于,所述当确定所述车辆处于变 道超车状态时,根据所述车辆当前的位置信息和所述目标位置信息,对所述车 辆的车轮转向角度进行调整,包括: 当确定所述车辆处于变道超车状态时,判断所述车辆当前的横坐标是否小 于所述目标横坐标的二分之一; 当所述车辆当前的横坐标小于所述目标横坐标的二分之一时,将所述车辆 的车轮转向角度调整为第一车轮转向角度; 当所述车辆当前的横坐标不小于所述目标横坐标的二分之一时,将所述车 辆的车轮转向角度调整为第二车轮转向角度。
9.根据权利要求1所述的方法,其特征在于,所述当确定所述车辆处于变 道超车状态时,根据所述车辆当前的位置信息和所述目标位置信息,对所述车 辆的车轮转向角度进行调整,包括: 当确定所述车辆处于变道超车状态时,判断所述车辆当前的纵坐标是否小 于所述目标纵坐标的二分之一; 当所述车辆当前的纵坐标小于所述目标纵坐标的二分之一时,将所述车辆 的车轮转向角度调整为第一车轮转向角度; 当所述车辆当前的纵坐标不小于所述目标纵坐标的二分之一时,将所述车 辆的车轮转向角度调整为第二车轮转向角度。
10.一种变道超车装置,其特征在于,所述装置包括: 获取模块,用于每隔预设时长获取车辆当前的行驶速度和车轮转向角度; 所述获取模块,还用于根据所述车辆当前的行驶速度和车轮转向角度,获 取所述车辆当前的位置信息,所述位置信息包括横坐标和纵坐标; 判断模块,用于根据所述车辆当前的位置信息和已确定的目标位置信息, 判断所述车辆是否处于变道超车状态,所述目标位置信息包括目标横坐标和目 标纵坐标; 调整模块,用于当确定所述车辆处于变道超车状态时,根据所述车辆当前 的位置信息和所述目标位置信息,对所述车辆的车轮转向角度进行调整; 行驶模块,用于根据调整后的车轮转向角度行驶,直至当所述车辆未处于 变道超车状态时为止。
11.根据权利要求10所述的装置,其特征在于,所述获取模块还用于获取 所述车辆与检测到的障碍车在车道线方向上的距离;当确定所述距离小于预设 阈值时,获取所述车辆的初始状态信息,所述初始状态信息包括所述车辆与车 道线之间的距离、所述车辆与所述障碍车在车道线方向上的距离、所述车辆的 初始行驶速度和初始车轮转向角度;根据所述初始状态信息,获取所述车辆的 目标位置信息;根据所述初始状态信息,获取第一车轮转向角度和第二车轮转 向角度。
12.根据权利要求11所述的装置,其特征在于,所述获取模块还用于根据 所述初始状态信息,应用以下公式,获取所述车辆的目标位置信息: xg=Dx;
13.根据权利要求11所述的装置,其特征在于,所述获取模块还用于根据 所述初始状态信息,应用以下公式,获取第一车轮转向角度和第二车轮转向角 度:
14.根据权利要求10所述的装置,其特征在于,所述获取模块还用于根据 所述车辆当前的行驶速度和车轮转向角度,应用以下公式,获取所述车辆当前 的位置信息:
15.根据权利要求10所述的装置,其特征在于,所述判断模块还用于判断 所述车辆当前的横坐标是否小于所述目标横坐标;当所述车辆当前的横坐标小 于所述目标横坐标时,确定所述车辆处于变道超车状态;当所述车辆当前的横 坐标不小于所述目标横坐标时,确定所述车辆未处于变道超车状态。
16.根据权利要求10所述的装置,其特征在于,所述判断模块还用于判断 所述车辆当前的纵坐标是否小于所述目标纵坐标;当所述车辆当前的纵坐标小 于所述目标纵坐标时,确定所述车辆处于变道超车状态;当所述车辆当前的纵 坐标不小于所述目标纵坐标时,确定所述车辆未处于变道超车状态。
17.根据权利要求10所述的装置,其特征在于,所述调整模块还用于当确 定所述车辆处于变道超车状态时,判断所述车辆当前的横坐标是否小于所述目 标横坐标的二分之一;当所述车辆当前的横坐标小于所述目标横坐标的二分之 一时,将所述车辆的车轮转向角度调整为第一车轮转向角度;当所述车辆当前 的横坐标不小于所述目标横坐标的二分之一时,将所述车辆的车轮转向角度调 整为第二车轮转向角度。
18.根据权利要求10所述的装置,其特征在于,所述调整模块还用于当确 定所述车辆处于变道超车状态时,判断所述车辆当前的纵坐标是否小于所述目 标纵坐标的二分之一;当所述车辆当前的纵坐标小于所述目标纵坐标的二分之 一时,将所述车辆的车轮转向角度调整为第一车轮转向角度;当所述车辆当前 的纵坐标不小于所述目标纵坐标的二分之一时,将所述车辆的车轮转向角度调 整为第二车轮转向角度。
翻译:技术领域
本发明涉及车辆技术领域,特别涉及一种变道超车方法和装置。
背景技术
随着车辆技术的不断发展,车辆可以利用环境感知系统,如摄像机、雷达 等,对车道线或障碍车等进行检测,并根据车道线或障碍车的位置信息,控制 车辆实现智能变道超车。
当车辆在行驶过程中利用环境感知系统检测到障碍车时,可以从一个车道 变到另一个车道,而在变道过程中,车身会从平行于车道线的状态切换为与车 道线有一定夹角的状态。此时,车身角度的变化会导致环境感知系统中的摄像 机或雷达无法准确地检测到车道线或障碍车。则为了在车身角度变化时实现智 能变道超车,车辆可以预先设定多个行驶速度对应的方向盘转动角度,当车辆 变道时,可以根据预先设定的多个行驶速度以及对应的方向盘转动角度,利用 插值法,获取当前行驶速度对应的方向盘转动角度,再根据计算得到的方向盘 转动角度,调整车辆的行驶状态,从而实现智能变道超车。
在实现本发明的过程中,发明人发现现有技术至少存在以下问题:
利用插值法计算当前行驶速度对应的方向盘转动角度时,可能会存在误差, 从而导致车辆按照计算出的方向盘转动角度调整行驶情况时,可能会出现车辆 偏离车道或刮擦障碍车等问题,可靠性差。
发明内容
为了解决现有技术的问题,本发明实施例提供了一种变道超车方法和装置。 所述技术方案如下:
一方面,提供了一种变道超车方法,所述方法包括:
每隔预设时长获取车辆当前的行驶速度和车轮转向角度;
根据所述车辆当前的行驶速度和车轮转向角度,获取所述车辆当前的位置 信息,所述位置信息包括横坐标和纵坐标;
根据所述车辆当前的位置信息和已确定的目标位置信息,判断所述车辆是 否处于变道超车状态,所述目标位置信息包括目标横坐标和目标纵坐标;
当确定所述车辆处于变道超车状态时,根据所述车辆当前的位置信息和所 述目标位置信息,对所述车辆的车轮转向角度进行调整;
根据调整后的车轮转向角度行驶,直至当所述车辆未处于变道超车状态时 为止。
可选地,所述方法还包括:
获取所述车辆与检测到的障碍车在车道线方向上的距离;
当确定所述距离小于预设阈值时,获取所述车辆的初始状态信息,所述初 始状态信息包括所述车辆与车道线之间的距离、所述车辆与所述障碍车在车道 线方向上的距离、所述车辆的初始行驶速度和初始车轮转向角度;
根据所述初始状态信息,获取所述车辆的目标位置信息;
根据所述初始状态信息,获取第一车轮转向角度和第二车轮转向角度。
可选地,所述根据所述初始状态信息,获取所述车辆的目标位置信息,包 括:
根据所述初始状态信息,应用以下公式,获取所述车辆的目标位置信息:
xg=Dx;
其中,xg用于表示所述车辆的目标横坐标,yg用于表示所述车辆的目标纵 坐标,Dx用于表示所述车辆与所述障碍车在车道线方向上的距离,Dy用于表示 所述车辆与车道线之间的距离,W用于表示车道宽度。
可选地,所述根据所述初始状态信息,获取第一车轮转向角度和第二车轮 转向角度,包括:
根据所述初始状态信息,应用以下公式,获取第一车轮转向角度和第二车 轮转向角度:
β1=-(β2+θ0);
其中,Dx用于表示所述车辆与所述障碍车在车道线方向上的距离,Dy用于 表示所述车辆与车道线之间的距离,β2用于表示所述第二车轮转向角度,W用 于表示车道宽度,θ0用于表示所述车辆的初始行驶方向与车道线之间的夹角,v0用于表示所述初始行驶速度,φ0用于表示所述初始车轮转向角度,L用于表示车 辆前轮与后轮之间的距离,β1用于表示所述第一车轮转向角度。
可选地,所述根据所述车辆当前的行驶速度和车轮转向角度,获取所述车 辆当前的位置信息,包括:
根据所述车辆当前的行驶速度和车轮转向角度,应用以下公式,获取所述 车辆当前的位置信息:
其中,t1用于表示当前时间点,v(t1)用于表示所述车辆当前的行驶速度,φ(t1) 用于表示所述车辆当前的车轮转向角度,L用于表示所述车辆的前轮与后轮之间 的距离,θ(t1)用于表示所述车辆当前的行驶方向与车道线之间的夹角,x用于表 示所述车辆当前的横坐标,y用于表示所述车辆当前的纵坐标。
可选地,所述根据所述车辆当前的位置信息和已确定的目标位置信息,判 断所述车辆是否处于变道超车状态,包括:
判断所述车辆当前的横坐标是否小于所述目标横坐标;
当所述车辆当前的横坐标小于所述目标横坐标时,确定所述车辆处于变道 超车状态;
当所述车辆当前的横坐标不小于所述目标横坐标时,确定所述车辆未处于 变道超车状态。
可选地,所述根据所述车辆当前的位置信息和已确定的目标位置信息,判 断所述车辆是否处于变道超车状态,包括:
判断所述车辆当前的纵坐标是否小于所述目标纵坐标;
当所述车辆当前的纵坐标小于所述目标纵坐标时,确定所述车辆处于变道 超车状态;
当所述车辆当前的纵坐标不小于所述目标纵坐标时,确定所述车辆未处于 变道超车状态。
可选地,所述当确定所述车辆处于变道超车状态时,根据所述车辆当前的 位置信息和所述目标位置信息,对所述车辆的车轮转向角度进行调整,包括:
当确定所述车辆处于变道超车状态时,判断所述车辆当前的横坐标是否小 于所述目标横坐标的二分之一;
当所述车辆当前的横坐标小于所述目标横坐标的二分之一时,将所述车辆 的车轮转向角度调整为第一车轮转向角度;
当所述车辆当前的横坐标不小于所述目标横坐标的二分之一时,将所述车 辆的车轮转向角度调整为第二车轮转向角度。
可选地,所述当确定所述车辆处于变道超车状态时,根据所述车辆当前的 位置信息和所述目标位置信息,对所述车辆的车轮转向角度进行调整,包括:
当确定所述车辆处于变道超车状态时,判断所述车辆当前的纵坐标是否小 于所述目标纵坐标的二分之一;
当所述车辆当前的纵坐标小于所述目标纵坐标的二分之一时,将所述车辆 的车轮转向角度调整为第一车轮转向角度;
当所述车辆当前的纵坐标不小于所述目标纵坐标的二分之一时,将所述车 辆的车轮转向角度调整为第二车轮转向角度。
另一方面,提供了一种变道超车装置,所述装置包括:
获取模块,用于每隔预设时长获取车辆当前的行驶速度和车轮转向角度;
所述获取模块,还用于根据所述车辆当前的行驶速度和车轮转向角度,获 取所述车辆当前的位置信息,所述位置信息包括横坐标和纵坐标;
判断模块,用于根据所述车辆当前的位置信息和已确定的目标位置信息, 判断所述车辆是否处于变道超车状态,所述目标位置信息包括目标横坐标和目 标纵坐标;
调整模块,用于当确定所述车辆处于变道超车状态时,根据所述车辆当前 的位置信息和所述目标位置信息,对所述车辆的车轮转向角度进行调整;
行驶模块,用于根据调整后的车轮转向角度行驶,直至当所述车辆未处于 变道超车状态时为止。
可选地,所述获取模块还用于获取所述车辆与检测到的障碍车在车道线方 向上的距离;当确定所述距离小于预设阈值时,获取所述车辆的初始状态信息, 所述初始状态信息包括所述车辆与车道线之间的距离、所述车辆与所述障碍车 在车道线方向上的距离、所述车辆的初始行驶速度和初始车轮转向角度;根据 所述初始状态信息,获取所述车辆的目标位置信息;根据所述初始状态信息, 获取第一车轮转向角度和第二车轮转向角度。
可选地,所述获取模块还用于根据所述初始状态信息,应用以下公式,获 取所述车辆的目标位置信息:
xg=Dx;
其中,xg用于表示所述车辆的目标横坐标,yg用于表示所述车辆的目标纵 坐标,Dx用于表示所述车辆与所述障碍车在车道线方向上的距离,Dy用于表示 所述车辆与车道线之间的距离,W用于表示车道宽度。
可选地,所述获取模块还用于根据所述初始状态信息,应用以下公式,获 取第一车轮转向角度和第二车轮转向角度:
β1=-(β2+θ0);
其中,Dx用于表示所述车辆与所述障碍车在车道线方向上的距离,Dy用于 表示所述车辆与车道线之间的距离,β2用于表示所述第二车轮转向角度,W用 于表示车道宽度,θ0用于表示所述车辆的初始行驶方向与车道线之间的夹角,v0用于表示所述初始行驶速度,φ0用于表示所述初始车轮转向角度,L用于表示车 辆前轮与后轮之间的距离,β1用于表示所述第一车轮转向角度。
可选地,所述获取模块还用于根据所述车辆当前的行驶速度和车轮转向角 度,应用以下公式,获取所述车辆当前的位置信息:
其中,t1用于表示当前时间点,v(t1)用于表示所述车辆当前的行驶速度,φ(t1) 用于表示所述车辆当前的车轮转向角度,L用于表示所述车辆的前轮与后轮之间 的距离,θ(t1)用于表示所述车辆当前的行驶方向与车道线之间的夹角,x用于表 示所述车辆当前的横坐标,y用于表示所述车辆当前的纵坐标。
可选地,所述判断模块还用于判断所述车辆当前的横坐标是否小于所述目 标横坐标;当所述车辆当前的横坐标小于所述目标横坐标时,确定所述车辆处 于变道超车状态;当所述车辆当前的横坐标不小于所述目标横坐标时,确定所 述车辆未处于变道超车状态。
可选地,所述判断模块还用于判断所述车辆当前的纵坐标是否小于所述目 标纵坐标;当所述车辆当前的纵坐标小于所述目标纵坐标时,确定所述车辆处 于变道超车状态;当所述车辆当前的纵坐标不小于所述目标纵坐标时,确定所 述车辆未处于变道超车状态。
可选地,所述调整模块还用于当确定所述车辆处于变道超车状态时,判断 所述车辆当前的横坐标是否小于所述目标横坐标的二分之一;当所述车辆当前 的横坐标小于所述目标横坐标的二分之一时,将所述车辆的车轮转向角度调整 为第一车轮转向角度;当所述车辆当前的横坐标不小于所述目标横坐标的二分 之一时,将所述车辆的车轮转向角度调整为第二车轮转向角度。
可选地,所述调整模块还用于当确定所述车辆处于变道超车状态时,判断 所述车辆当前的纵坐标是否小于所述目标纵坐标的二分之一;当所述车辆当前 的纵坐标小于所述目标纵坐标的二分之一时,将所述车辆的车轮转向角度调整 为第一车轮转向角度;当所述车辆当前的纵坐标不小于所述目标纵坐标的二分 之一时,将所述车辆的车轮转向角度调整为第二车轮转向角度。
本发明实施例提供的技术方案带来的有益效果是:
本发明实施例提供的方法和装置,通过每隔预设时长获取车辆当前的行驶 速度和车轮转向角度,根据该车辆当前的行驶速度和车轮转向角度,获取该车 辆当前的位置信息,根据该车辆当前的位置信息和已确定的目标位置信息,判 断该车辆是否处于变道超车状态,当确定该车辆处于变道超车状态时,根据该 车辆当前的位置信息和该目标位置信息,对该车辆的车轮转向角度进行调整, 避免了车轮转向角度出现误差,则在车辆根据调整后的车轮转向角度行驶时, 避免了出现车辆偏离车道或刮擦障碍车等问题,提高了可靠性。
附图说明
为了更清楚地说明本发明实施例中的技术方案,下面将对实施例描述中所 需要使用的附图作简单地介绍,显而易见地,下面描述中的附图仅仅是本发明 的一些实施例,对于本领域普通技术人员来讲,在不付出创造性劳动的前提下, 还可以根据这些附图获得其他的附图。
图1是本发明实施例提供的一种变道超车方法的流程图;
图2A是本发明实施例提供的一种变道超车方法的流程图;
图2B是本发明实施例提供的一种车辆变道的示意图;
图2C是本发明实施例提供的一种车轮转向角度的示意图;
图2D是本发明实施例提供的一种车辆行驶轨迹的示意图;
图2E是本发明实施例提供的一种变道超车方法的操作流程示意图;
图3是本发明实施例提供的一种变道超车装置结构示意图。
具体实施方式
为使本发明的目的、技术方案和优点更加清楚,下面将结合附图对本发明 实施方式作进一步地详细描述。
图1是本发明实施例提供的一种变道超车方法的流程图。参见图1,所述方 法包括:
101、每隔预设时长获取车辆当前的行驶速度和车轮转向角度。
102、根据该车辆当前的行驶速度和车轮转向角度,获取该车辆当前的位置 信息,该位置信息包括横坐标和纵坐标。
103、根据该车辆当前的位置信息和已确定的目标位置信息,判断该车辆是 否处于变道超车状态,该目标位置信息包括目标横坐标和目标纵坐标。
104、当确定该车辆处于变道超车状态时,根据该车辆当前的位置信息和该 目标位置信息,对该车辆的车轮转向角度进行调整。
105、根据调整后的车轮转向角度行驶,直至当该车辆未处于变道超车状态 时为止。
本发明实施例提供的方法,通过每隔预设时长获取车辆当前的行驶速度和 车轮转向角度,根据该车辆当前的行驶速度和车轮转向角度,获取该车辆当前 的位置信息,根据该车辆当前的位置信息和已确定的目标位置信息,判断该车 辆是否处于变道超车状态,当确定该车辆处于变道超车状态时,根据该车辆当 前的位置信息和该目标位置信息,对该车辆的车轮转向角度进行调整,避免了 车轮转向角度出现误差,则在车辆根据调整后的车轮转向角度行驶时,避免了 出现车辆偏离车道或刮擦障碍车等问题,提高了可靠性。
可选地,该每隔预设时长获取车辆当前的行驶速度和车轮转向角度之前, 该方法还包括:
获取该车辆与检测到的障碍车在车道线方向上的距离;
当确定该距离小于预设阈值时,获取该车辆的初始状态信息,该初始状态 信息包括该车辆与车道线之间的距离、该车辆与该障碍车在车道线方向上的距 离、该车辆的初始行驶速度和初始车轮转向角度;
根据该初始状态信息,获取该车辆的目标位置信息;
根据该初始状态信息,获取第一车轮转向角度和第二车轮转向角度。
可选地,该根据该初始状态信息,获取该车辆的目标位置信息,包括:
根据该初始状态信息,应用以下公式,获取该车辆的目标位置信息:
xg=Dx;
其中,xg用于表示该车辆的目标横坐标,yg用于表示该车辆的目标纵坐标, Dx用于表示该车辆与该障碍车在车道线方向上的距离,Dy用于表示该车辆与车 道线之间的距离,W用于表示车道宽度。
可选地,该根据该初始状态信息,获取第一车轮转向角度和第二车轮转向 角度,包括:
根据该初始状态信息,应用以下公式,获取第一车轮转向角度和第二车轮 转向角度:
β1=-(β2+θ0);
其中,Dx用于表示该车辆与该障碍车在车道线方向上的距离,Dy用于表示 该车辆与车道线之间的距离,β2用于表示该第二车轮转向角度,W用于表示车 道宽度,θ0用于表示该车辆的初始行驶方向与车道线之间的夹角,v0用于表示该 初始行驶速度,φ0用于表示该初始车轮转向角度,L用于表示车辆前轮与后轮之 间的距离,β1用于表示该第一车轮转向角度。
可选地,该根据该车辆当前的行驶速度和车轮转向角度,获取该车辆当前 的位置信息,包括:
根据该车辆当前的行驶速度和车轮转向角度,应用以下公式,获取该车辆 当前的位置信息:
其中,t1用于表示当前时间点,v(t1)用于表示该车辆当前的行驶速度,φ(t1) 用于表示该车辆当前的车轮转向角度,L用于表示该车辆的前轮与后轮之间的距 离,θ(t1)用于表示该车辆当前的行驶方向与车道线之间的夹角,x用于表示该车 辆当前的横坐标,y用于表示该车辆当前的纵坐标。
可选地,该根据该车辆当前的位置信息和已确定的目标位置信息,判断该 车辆是否处于变道超车状态,包括:
判断该车辆当前的横坐标是否小于该目标横坐标;
当该车辆当前的横坐标小于该目标横坐标时,确定该车辆处于变道超车状 态;
当该车辆当前的横坐标不小于该目标横坐标时,确定该车辆未处于变道超 车状态。
可选地,该根据该车辆当前的位置信息和已确定的目标位置信息,判断该 车辆是否处于变道超车状态,包括:
判断该车辆当前的纵坐标是否小于该目标纵坐标;
当该车辆当前的纵坐标小于该目标纵坐标时,确定该车辆处于变道超车状 态;
当该车辆当前的纵坐标不小于该目标纵坐标时,确定该车辆未处于变道超 车状态。
可选地,该当确定该车辆处于变道超车状态时,根据该车辆当前的位置信 息和该目标位置信息,对该车辆的车轮转向角度进行调整,包括:
当确定该车辆处于变道超车状态时,判断该车辆当前的横坐标是否小于该 目标横坐标的二分之一;
当该车辆当前的横坐标小于该目标横坐标的二分之一时,将该车辆的车轮 转向角度调整为第一车轮转向角度;
当该车辆当前的横坐标不小于该目标横坐标的二分之一时,将该车辆的车 轮转向角度调整为第二车轮转向角度。
可选地,该当确定该车辆处于变道超车状态时,根据该车辆当前的位置信 息和该目标位置信息,对该车辆的车轮转向角度进行调整,包括:
当确定该车辆处于变道超车状态时,判断该车辆当前的纵坐标是否小于该 目标纵坐标的二分之一;
当该车辆当前的纵坐标小于该目标纵坐标的二分之一时,将该车辆的车轮 转向角度调整为第一车轮转向角度;
当该车辆当前的纵坐标不小于该目标纵坐标的二分之一时,将该车辆的车 轮转向角度调整为第二车轮转向角度。
上述所有可选技术方案,可以采用任意结合形成本发明的可选实施例,在 此不再一一赘述。
图2A是本发明实施例提供的一种变道超车方法的流程图。参见图2A,所 述方法包括:
201、车载设备获取车辆与检测到的障碍车在车道线方向上的距离,当确定 该距离小于预设阈值时,获取该车辆的初始状态信息,根据该初始状态信息, 获取该车辆的目标位置信息、第一车轮转向角度和第二车轮转向角度,该目标 位置信息包括目标横坐标和目标纵坐标。
车辆上配置有车载设备,在车辆沿着车道线行驶的过程中,车载设备可以 利用环境感知系统,如摄像机、雷达等,对该车辆前方一定范围内的障碍物进 行检测,当检测到障碍车时,为了躲避该障碍车,该车辆可以变道超车。
如图2B所示,车辆检测到障碍车,从车道1变到车道2的过程中,车身会 从平行于车道线的状态(状态1)切换为与车道线有一定夹角的状态(状态2)。 此时,车身角度的变化会导致摄像机或雷达无法准确地检测到车道线和障碍车 的位置,可能会出现车辆偏离车道或刮擦障碍车等问题。
为了避免这些问题的出现,该车载设备可以获取车辆的目标位置信息、第 一车轮转向角度和第二车轮转向角度,并在该车辆变道的过程中,根据该目标 位置信息、第一车轮转向角度和第二车轮转向角度,调整该车辆的车轮转向角 度,使得该车辆根据调整后的车轮转向角度行驶,从而实现变道超车。
首先,该车载设备获取该车辆的目标位置信息、第一车轮转向角度和第二 车轮转向角度,具体包括以下步骤:
(1)该车载设备获取该车辆与检测到的障碍车在车道线方向上的距离,当 确定该距离小于预设阈值时,获取该车辆的初始状态信息。
具体地,该车载设备通过摄像机检测到障碍车时,采用图像处理技术,获 取该车辆与障碍车在车道线方向上的距离。进一步地,该车载设备可以通过摄 像机进行内外参数标定,采用三线标定法,确定实际坐标系与摄像机的图像坐 标系之间的一一映射关系,则该车载设备可以通过摄像机采集障碍车的图像, 计算在采集得到的图像中车辆与该障碍车在车道线方向上的距离,则根据确定 的映射关系以及在图像中车辆与该障碍车在车道线方向上的距离,可以获取该 车辆与该障碍车在车道线方向上的实际距离。
当该车载设备确定该车辆与该障碍车在车道线方向上的距离之后,判断该 距离是否小于该预设阈值。
其中,该预设阈值用于表示两辆车在车道线方向上的安全距离,当两辆车 之间的距离小于该预设阈值时,表示两辆车之间的距离过近,后一车辆需要进 行变道超车才能躲避前一车辆,而当两辆车之间的距离不小于该预设阈值时, 表示两辆车之间的距离较远,后一车辆无需躲避前一车辆。
则在本发明实施例中,当该车载设备确定该车辆与该障碍车在车道线方向 上的距离不小于该预设阈值时,确定该车辆无需躲避该障碍车,则该车辆保持 当前的行驶状态即可。而当该车载设备确定该距离小于该预设阈值时,为了躲 避该障碍车,该车辆可以进入变道超车状态。此时,该车载设备可以获取该车 辆当前的状态信息,作为变道超车状态的初始状态信息。
其中,该初始状态信息包括该车辆与车道线之间的距离、该车辆与该障碍 车在车道线方向上的距离、该车辆的初始行驶速度和初始车轮转向角度。
具体地,该车载设备通过摄像机对车道线进行检测,采用图像增强技术增 强车道边缘,并采用自适应二值化算法提取车道线特征,再根据车道线特征提 取车道线内侧边缘,通过霍夫变换拟合出车道线,最后采用车道线跟踪技术得 到稳定的车道线。再根据摄像机采集到的稳定车道线进行标定,根据标定结果 获取该车辆与车道线之间的实际距离。
另外,该车载设备可以配置车速传感器和车轮转向角度检测系统,则可以 通过车速传感器,获取该车辆进入变道超车状态时的行驶速度,作为初始行驶 速度,并通过车轮转向角度检测系统,获取该车辆进入变道超车状态时的车轮 转向角度,作为初始车轮转向角度。
(2)该车载设备根据该初始状态信息,获取该车辆的目标位置信息、第一 车轮转向角度和第二车轮转向角度。
其中,该目标位置信息用于指示当该车辆完成变道超车时的位置,可以根 据该初始状态信息估计得到。
具体地,该车载设备可以根据该车辆的初始状态信息和该障碍车的位置信 息,获取该车辆的目标位置信息,该目标位置信息包括目标横坐标和目标纵坐 标。
该车载设备可以将该车辆进入变道超车状态时所在的位置作为坐标系原 点,并将车道线方向作为横轴,将车辆的行驶方向作为横轴的正方向,将垂直 于车道线的方向作为纵轴,建立坐标系,并根据该车辆的初始状态信息和该坐 标系,确定目标位置信息。
具体地,该车载设备可以应用以下公式,获取该车辆的目标位置信息:
xg=Dx;
其中,xg用于表示该车辆的目标横坐标,yg用于表示该车辆的目标纵坐标, Dx用于表示该车辆与该障碍车在车道线方向上的距离,Dy用于表示该车辆与车 道线之间的距离,W用于表示车道宽度,W的值可以预先设定或者通过摄像机 采用图像处理技术确定,本发明实施例对此不做限定。
需要说明的是,本发明实施例仅以上述坐标系为例进行说明,而在实际应 用中,该车载设备可以将该车辆进入变道超车状态时所在的位置作为坐标系原 点,并将车道线方向作为纵轴,将垂直于车道线的方向作为横轴,建立坐标系, 根据该初始状态信息和该坐标系确定该目标位置信息,具体的确定方式与上述 公式类似,在此不再赘述。
在本发明实施例中,该车载设备可以将该车辆的变道超车过程分为两个阶 段,使得该车辆在第一阶段按照第一车轮转向角度行驶,在第二阶段按照第二 车轮转向角度行驶之后,能够在目标位置处完成变道超车过程。则该车载设备 获取到目标位置信息之后,可以根据该初始状态信息和目标位置信息,获取该 第一车轮转向角度和该第二车轮转向角度。
具体地,该车载设备可以将沿逆时针旋转的方向作为正方向,即沿逆时针 旋转得到的角度为正值,将沿顺时针旋转的方向作为负方向,即沿顺时针旋转 得到的角度为负值。
相应的,参见图2C,该车载设备可以应用以下公式,获取第一车轮转向角 度和第二车轮转向角度:
β1=-(β2+θ0);
其中,Dx用于表示该车辆与该障碍车在车道线方向上的距离,Dy用于表示 该车辆与车道线之间的距离,β2用于表示该第二车轮转向角度,W用于表示车 道宽度,θ0用于表示该车辆的初始行驶方向与车道线之间的夹角,v0用于表示该 初始行驶速度,φ0用于表示该初始车轮转向角度,β1用于表示该第一车轮转向角 度,L用于表示车辆前轮与后轮之间的距离。
当然,该车载设备还可以将沿顺时针旋转的方向作为正方向,将沿逆时针 旋转的方向作为负方向,则该车载设备可以应用以下公式,获取第一车轮转向 角度和第二车轮转向角度:
β1=β2+θ0。
202、该车载设备每隔预设时长,执行下述步骤203-205,直至该车辆不再 处于变道超车状态为止。
当该车辆进入变道超车状态之后,该车载设备每隔预设时长,获取该车辆 当前的行驶速度和车轮转向角度,根据该车辆当前的位置信息和该目标位置信 息,对该车辆的车轮转向角度进行调整,直至变道超车完成为止。
其中,该预设时长可以为20毫秒、50毫秒等,本发明实施例对此不做限定。
需要说明的是,该车载设备可以通过多次试验确定该预设时长。具体地, 该车载设备可以根据车辆进入变道超车状态时的初始位置信息和目标位置信 息,计算得到理想轨迹,并设定样本预设时长,每隔该样本预设时长,计算该 车辆当前的位置信息,根据该车辆当前的位置信息和该目标位置信息,确定该 车辆当前处于哪一阶段,当确定该车辆当前处于第一阶段时,将该车辆的车轮 转向角度调整为第一车轮转向角度,当确定该车辆当前处于该第二阶段时,将 该车辆的车轮转向角度调整为第二车轮转向角度,则该车辆根据调整后的车轮 转向角度行驶,直至当该车辆到达目标位置附近时为止,根据计算出的多个位 置信息确定该车辆的实际行驶轨迹,并将该实际行驶轨迹与理想轨迹进行对比。
如图2D所示,车辆进入变道超车状态时的初始位置为(x0,y0),目标位置为 (xg,yg),车辆从初始位置到目标位置的理想轨迹如图2C中的实线轨迹所示。当 该车载设备确定车辆的实际行驶轨迹为轨迹1(虚线所示)时,表明该车载设备 确定该车辆进入第二阶段的时刻晚于车辆按照理想轨迹行驶时进入第二阶段的 时刻,也即是该样本预设时长设置的偏大,则应减小该样本预设时长。而当该 车载设备确定车辆的实际行驶轨迹为轨迹2(虚线所示)时,表明该车载设备确 定该车辆进入第二阶段的时刻早于车辆按照理想轨迹行驶时进入第二阶段的时 刻,也即是该样本预设时长设置的偏小,则应增大该样本预设时长。该车载设 备采用上述试验方式,多次对样本预设时长进行调整,确定每次调整后的样本 预设时长对应的实际行驶轨迹,直至实际行驶轨迹趋向于理想轨迹时为止,该 车载设备获取此时的样本预设时长,作为预设时长。
203、该车载设备获取该车辆当前的行驶速度和车轮转向角度,根据该车辆 当前的行驶速度和车轮转向角度,获取该车辆当前的位置信息,该位置信息包 括横坐标和纵坐标。
具体地,该车载设备每隔预设时长,通过车速传感器,获取该车辆当前的 行驶速度,并通过车轮转向角度检测系统,获取该车辆当前的车轮转向角度, 根据该车辆当前的行驶速度和车轮转向角度,应用以下公式,获取该车辆当前 的位置信息,该位置信息包括横坐标和纵坐标:
其中,t1用于表示当前时间点,v(t1)用于表示该车辆当前的行驶速度,φ(t1) 用于表示该车辆当前的车轮转向角度,L用于表示该车辆的前轮与后轮之间的距 离,θ(t1)用于表示该车辆当前的行驶方向与车道线之间的夹角,x用于表示该车 辆当前的横坐标,y用于表示该车辆当前的纵坐标。
204、该车载设备根据该车辆当前的位置信息和已确定的目标位置信息,判 断该车辆是否处于变道超车状态,如果是,执行步骤205,如果否,结束。
具体地,该步骤204可以包括以下步骤(1)、(2)或(3):
(1)判断该车辆当前的横坐标是否小于该目标横坐标,当该车辆当前的横 坐标小于该目标横坐标时,确定该车辆处于变道超车状态,当该车辆当前的横 坐标不小于该目标横坐标时,确定该车辆未处于变道超车状态。
(2)判断该车辆当前的纵坐标是否小于该目标纵坐标,当该车辆当前的纵 坐标小于该目标纵坐标时,确定该车辆处于变道超车状态,当该车辆当前的纵 坐标不小于该目标纵坐标时,确定该车辆未处于变道超车状态。
(3)判断该车辆当前的横坐标是否小于该目标横坐标,并判断当前的纵坐 标是否小于该目标纵坐标,当该车辆当前的横坐标小于该目标横坐标,且该车 辆当前的纵坐标小于该目标纵坐标时,确定该车辆处于变道超车状态,当该车 辆当前的横坐标不小于该目标横坐标,且该车辆当前的纵坐标不小于该目标纵 坐标时,确定该车辆未处于变道超车状态。
本发明实施例中,根据该车辆当前的位置和目标位置进行判断,当确定该 车辆当前还未行驶到该目标位置时,可以确定该变道超车过程还未完成,也即 是该车辆还处于变道超车状态。而当确定该车辆当前已行驶到该目标位置时, 可以确定该变道超车过程已完成,也即是该车辆不再处于变道超车状态。
205、当该车载设备确定该车辆处于变道超车状态时,根据该车辆当前的位 置信息和该目标位置信息,对该车辆的车轮转向角度进行调整,并控制该车辆 根据调整后的车轮转向角度行驶。
当该车载设备确定该车辆处于变道超车状态时,需要根据该车辆当前的位 置信息和该目标位置信息,确定该车辆处于变道超车过程的哪一阶段,当该车 辆处于该第一阶段时,该车辆的车轮转向角度调整为第一车轮转向角度,当该 车辆处于该第二阶段时,该车辆的车轮转向角度调整为第二车轮转向角度。
具体地,根据该车辆当前的位置信息和该目标位置信息,对该车辆的车轮 转向角度进行调整,可以包括以下步骤(1)、(2)或(3):
(1)判断该车辆当前的横坐标是否小于该目标横坐标的二分之一,当该车 辆当前的横坐标小于该目标横坐标的二分之一时,将该车辆的车轮转向角度调 整为第一车轮转向角度,当该车辆当前的横坐标不小于该目标横坐标的二分之 一时,将该车辆的车轮转向角度调整为第二车轮转向角度。
(2)判断该车辆当前的纵坐标是否小于该目标纵坐标的二分之一,当该车 辆当前的纵坐标小于该目标纵坐标的二分之一时,将该车辆的车轮转向角度调 整为第一车轮转向角度,当该车辆当前的纵坐标不小于该目标纵坐标的二分之 一时,将该车辆的车轮转向角度调整为第二车轮转向角度。
(3)判断该车辆当前的横坐标是否小于该目标横坐标的二分之一,并判断 该车辆当前的纵坐标是否小于该目标纵坐标的二分之一,当该车辆当前的横坐 标小于该目标横坐标的二分之一,且该车辆当前的纵坐标小于该目标纵坐标的 二分之一时,将该车辆的车轮转向角度调整为第一车轮转向角度,当该车辆当 前的横坐标不小于该目标横坐标的二分之一,且该车辆当前的纵坐标不小于该 目标纵坐标的二分之一时,将该车辆的车轮转向角度调整为第二车轮转向角度。
该车载设备确定该车辆的车轮转向角度之后,根据调整后的车轮转向角度 行驶,直至当该车辆到达目标位置,不再处于变道超车状态时为止。
在本发明实施例中,在变道超车的过程中,该车辆进入该第一阶段时,将 该车辆的车轮转向角度调整为第一车轮转向角度,则在第一阶段中,该车辆的 车轮转向角度保持为该第一车轮转向角度不变。当确定该车辆已经行驶到车辆 的初始位置与目标位置之间的中点时,该车辆进入第二阶段,此时,将该车辆 的车轮转向角度调整为第二车轮转向角度,则在第二阶段中,该车辆的车轮转 向角度保持为该第二车轮转向角度不变。
另外,该车载设备确定该车辆未处于变道超车状态时,不再根据该车辆当 前的位置信息和该目标位置信息,对该车辆的车轮转向角度进行调整。进一步 地,当确定该车辆未处于变道超车状态时,表示变道超车过程完成,则该车辆 继续沿着车道线的方向行驶即可,在行驶过程中,该车载设备继续利用环境感 知系统检测车道线或障碍车,实现车道保持的功能。
实际应用时,本发明实施例提供的变道超车方法的操作流程可以如图2E所 示,该操作流程可以包括:
1、车载设备利用环境感知系统进行检测,当未检测到障碍车时,利用环境 感知系统检测车道线,使得车辆维持车道保持状态,当检测到障碍车时,继续 执行下述步骤2;
2、该车载设备获取该车辆与该障碍车在车道线方向上的距离Dx,当确定该 距离不小于预设阈值Dmin时,即Dx≥Dmin时,利用环境感知系统检测车道线,使 得车辆维持车道保持状态。而当确定该距离小于预设阈值Dmin时,即Dx<Dmin时, 进入变道超车状态,继续执行下述步骤3;
3、在变道超车过程中,该车载设备每隔预设时长,获取该车辆当前位置(x,y) 和目标位置(xg,yg),当确定该车辆当前位置已到达目标位置,即x≥xg且y≥yg时, 利用环境感知系统检测车道线,使得车辆切换为车道保持状态。而当确定该车 辆当前位置未到达目标位置,即x<xg或y<yg时,该车辆维持变道超车状态,按 照车辆当前所处的阶段,调整该车辆的车轮转向角度,直至当该车辆到达目标 位置,不再处于变道超车状态时为止。
本发明实施例提供的方法,通过每隔预设时长获取车辆当前的行驶速度和 车轮转向角度,根据该车辆当前的行驶速度和车轮转向角度,获取该车辆当前 的位置信息,根据该车辆当前的位置信息和已确定的目标位置信息,判断该车 辆是否处于变道超车状态,当确定该车辆处于变道超车状态时,根据该车辆当 前的位置信息和该目标位置信息,对该车辆的车轮转向角度进行调整,避免了 车轮转向角度出现误差,则在车辆根据调整后的车轮转向角度行驶时,避免了 出现车辆偏离车道或刮擦障碍车等问题,提高了可靠性。
图3是本发明实施例提供的一种变道超车装置结构示意图。参见图3,所述 装置包括:
获取模块301,用于每隔预设时长获取车辆当前的行驶速度和车轮转向角 度;
该获取模块301,还用于根据该车辆当前的行驶速度和车轮转向角度,获取 该车辆当前的位置信息,该位置信息包括横坐标和纵坐标;
判断模块302,用于根据该车辆当前的位置信息和已确定的目标位置信息, 判断该车辆是否处于变道超车状态,该目标位置信息包括目标横坐标和目标纵 坐标;
调整模块303,用于当确定该车辆处于变道超车状态时,根据该车辆当前的 位置信息和该目标位置信息,对该车辆的车轮转向角度进行调整;
行驶模块304,用于根据调整后的车轮转向角度行驶,直至当该车辆未处于 变道超车状态时为止。
本发明实施例提供的装置,通过每隔预设时长获取车辆当前的行驶速度和 车轮转向角度,根据该车辆当前的行驶速度和车轮转向角度,获取该车辆当前 的位置信息,根据该车辆当前的位置信息和已确定的目标位置信息,判断该车 辆是否处于变道超车状态,当确定该车辆处于变道超车状态时,根据该车辆当 前的位置信息和该目标位置信息,对该车辆的车轮转向角度进行调整,避免了 车轮转向角度出现误差,则在车辆根据调整后的车轮转向角度行驶时,避免了 出现车辆偏离车道或刮擦障碍车等问题,提高了可靠性。
可选地,该获取模块301还用于获取该车辆与检测到的障碍车在车道线方 向上的距离;当确定该距离小于预设阈值时,获取该车辆的初始状态信息,该 初始状态信息包括该车辆与车道线之间的距离、该车辆与该障碍车在车道线方 向上的距离、该车辆的初始行驶速度和初始车轮转向角度;根据该初始状态信 息,获取该车辆的目标位置信息;根据该初始状态信息,获取第一车轮转向角 度和第二车轮转向角度。
可选地,该获取模块301还用于根据该初始状态信息,应用以下公式,获 取该车辆的目标位置信息:
xg=Dx;
其中,xg用于表示该车辆的目标横坐标,yg用于表示该车辆的目标纵坐标, Dx用于表示该车辆与该障碍车在车道线方向上的距离,Dy用于表示该车辆与车 道线之间的距离,W用于表示车道宽度。
可选地,该获取模块301还用于根据该初始状态信息,应用以下公式,获 取第一车轮转向角度和第二车轮转向角度:
β1=-(β2+θ0);
其中,Dx用于表示该车辆与该障碍车在车道线方向上的距离,Dy用于表示 该车辆与车道线之间的距离,β2用于表示该第二车轮转向角度,W用于表示车 道宽度,θ0用于表示该车辆的初始行驶方向与车道线之间的夹角,v0用于表示该 初始行驶速度,φ0用于表示该初始车轮转向角度,L用于表示车辆前轮与后轮之 间的距离,β1用于表示该第一车轮转向角度。
可选地,该获取模块301还用于根据该车辆当前的行驶速度和车轮转向角 度,应用以下公式,获取该车辆当前的位置信息: