一种车辆的自动换道方法及装置

文档序号:1552300 发布日期:2020-01-21 浏览:6次 >En<

阅读说明:本技术 一种车辆的自动换道方法及装置 (Automatic lane changing method and device for vehicle ) 是由 涂强 苏阳 肖志光 梁志远 于 2018-07-12 设计创作,主要内容包括:本申请公开一种车辆的自动换道方法及装置,属于车辆技术领域,包括:处于自动驾驶状态的车辆接收换道请求,预测到达换道终点时车辆的运动状态,为车辆规划第i时刻的换道线路和车速,根据换道线路的曲率、车速和方向盘转角模型确定第i时刻车辆的方向盘转角,若该转角未落入有效的转角范围内,则返回为车辆规划第i时刻的换道线路和车速的步骤,否则,根据车辆运动模型、第i时刻车辆的运动状态和方向盘转角确定第i+1时刻车辆的运动状态,若第i+1时刻车辆的运动状态与预测的运动状态之间的误差大于预设误差,则将i更新为i+1,返回为车辆规划第i时刻的换道线路和车速的步骤;否则,根据规划的各时刻的换道线路和车速驱动车辆进行换道。(The application discloses automatic lane changing method and device of a vehicle, belongs to the technical field of vehicles, and comprises the following steps: the method comprises the steps that a vehicle in an automatic driving state receives a lane changing request, the motion state of the vehicle is predicted when the vehicle reaches a lane changing terminal, a lane changing line and the vehicle speed at the ith moment are planned for the vehicle, the steering wheel angle of the vehicle at the ith moment is determined according to the curvature of the lane changing line, the vehicle speed and a steering wheel angle model, if the steering angle does not fall into an effective steering angle range, the step of planning the lane changing line and the vehicle speed at the ith moment is returned to the vehicle, otherwise, the motion state of the vehicle at the (i &#43; 1) th moment is determined according to the vehicle motion model, the motion state of the vehicle at the ith moment and the steering wheel angle, if the error between the motion state of the vehicle at the (i &#43; 1) th moment and the predicted motion state is larger than the preset error, i is updated to be i &#43;1, and the step of planning the lane; otherwise, driving the vehicle to change the lane according to the planned lane change line and the planned vehicle speed at each moment.)

一种车辆的自动换道方法及装置

技术领域

本申请涉及车辆技术领域,尤其涉及一种车辆的自动换道方法及装置。

背景技术

随着汽车技术的快速发展,自动驾驶技术在出行安全、节能环保等方面都显现出巨大潜力,而作为半自动驾驶技术的主推方向之一,自动换道已成为各大汽车厂商的研究重点。

现有技术中,当处于自动驾驶状态的车辆接收到换道请求时,可根据换道请求中携带的换道方向信息确定换道后车辆行驶的车道,并可预测在该车道中结束换道时车辆的位置信息,之后,以当前位置为起始位置,预测的位置为目标位置,以给定条件,如换道时间最短,为优化目标来为车辆规划换道线路,之后,按照规划的换道线路驱动车辆进行换道,这样,考虑的因素较少,在换道过程中有可能会出现某时刻的方向盘转角过大,从而导致换道不成功的情况。

可见,现有技术中在自动换道的过程中可能会出现某时刻的方向盘转角过大,而导致换道不成功的问题。

发明内容

本申请实施例提供一种车辆的自动换道方法及装置,用以解决现有技术中在自动换道过程中可能会出现某时刻的方向盘转角过大,而导致换道不成功的问题。

第一方面,本申请实施例提供的一种车辆的自动换道方法,包括:

处于自动驾驶状态的车辆接收换道请求,所述换道请求中携带有换道方向信息;

根据所述换道方向信息、采集到的前方图像和当前的车速预测到达换道终点时所述车辆的运动状态;

为所述车辆规划第i时刻的换道线路和车速,其中,第i时刻的换道线路和车速是以第i时刻所述车辆的运动状态为起始运动状态、预测的所述车辆的运动状态为目标运动状态进行规划得到的,根据第i时刻换道线路的曲率、车速和建立的用于确定方向盘转角的模型,确定第i时刻所述车辆的方向盘转角,i为大于或者等于0的整数;

判断第i时刻所述车辆的方向盘转角是否落入有效的方向盘转角范围内,所述有效的方向盘转角范围是根据换道起点的位置和所述换道终点的位置确定的,若否,则返回为所述车辆规划第i时刻的换道线路和车速的步骤,若是,则根据车辆运动模型、第i时刻所述车辆的运动状态和方向盘转角,确定第i+1时刻所述车辆的运动状态;

判断第i+1时刻所述车辆的运动状态与所述目标运动状态之间的误差是否大于预设误差,若是,则将i更新为i+1,并返回为所述车辆规划第i时刻的换道线路和车速的步骤;若否,则根据为所述车辆规划的各时刻的换道线路和车速驱动所述车辆进行换道。

采用上述方案,可根据换道起点的位置和换道终点的位置确定换道过程中有效的方向盘转角范围,进而保证换道过程中各时刻车辆的方向盘转角均落入有效的方向盘转角范围内,因此,可有效避免由于换道过程中某时刻的方向盘转角过大而导致无法换道的情况,有效提高换道成功率。

第二方面,本申请实施例提供的一种车辆的自动换道装置,包括:

接收模块,用于处于自动驾驶状态的车辆接收换道请求,所述换道请求中携带有换道方向信息;

预测模块,用于根据所述换道方向信息、采集到的前方图像和当前的车速预测到达换道终点时所述车辆的运动状态;

规划模块,用于为所述车辆规划第i时刻的换道线路和车速,其中,第i时刻的换道线路和车速是以第i时刻所述车辆的运动状态为起始运动状态、预测的所述车辆的运动状态为目标运动状态进行规划得到的,根据第i时刻换道线路的曲率、车速和建立的用于确定方向盘转角的模型,确定第i时刻所述车辆的方向盘转角,判断第i时刻所述车辆的方向盘转角是否落入有效的方向盘转角范围内,所述有效的方向盘转角范围是根据换道起点的位置和所述换道终点的位置确定的,若否,则返回为所述车辆规划第i时刻的换道线路和车速的步骤,若是,则根据车辆运动模型、第i时刻所述车辆的运动状态和方向盘转角,确定第i+1时刻所述车辆的运动状态,i为大于或者等于0的整数;

驱动模块,用于判断第i+1时刻所述车辆的运动状态与所述目标运动状态之间的误差是否大于预设误差,若是,则将i更新为i+1,并返回为所述车辆规划第i时刻的换道线路和车速的步骤;若否,则根据为所述车辆规划的各时刻的换道线路和车速驱动所述车辆进行换道。

第三方面,本申请实施例提供的一种电子设备,包括:至少一个处理器,以及与所述至少一个处理器通信连接的存储器,其中:

存储器存储有可被至少一个处理器执行的指令,该指令被所述至少一个处理器执行,以使所述至少一个处理器能够执行上述车辆的自动换道方法。

第四方面,本申请实施例提供的一种计算机可读介质,存储有计算机可执行指令,所述计算机可执行指令用于执行上述车辆的自动换道方法。

另外,第二方面至第四方面中任一种设计方式所带来的技术效果可参见第一方面中不同实现方式所带来的技术效果,此处不再赘述。

本申请的这些方面或其它方面在以下实施例的描述中会更加简明易懂。

附图说明

此处所说明的附图用来提供对本申请的进一步理解,构成本申请的一部分,本申请的示意性实施例及其说明用于解释本申请,并不构成对本申请的不当限定。在附图中:

图1为本申请实施例提供的车辆自动换道的示意图;

图2为本申请实施例提供的预测到达换道终点时车辆的运动状态的方法流程图;

图3为本申请实施例提供的车辆二自由度模型的示意图;

图4为本申请实施例提供的换道线路规划结果示意图;

图5为本申请实施例提供的车辆的自动换道方法的流程图;

图6为本申请实施例提供的用于实现车辆的自动换道方法的电子设备的结构示意图;

图7为本申请实施例提供的又一用于实现车辆的自动换道方法的电子设备的结构示意图。

具体实施方式

为了解决现有技术中在自动换道过程中可能会出现某时刻的方向盘转角过大,而导致换道不成功的问题,本申请实施例提供了一种车辆的自动换道方法及装置。

以下结合说明书附图对本申请的优选实施例进行说明,应当理解,此处所描述的优选实施例仅用于说明和解释本申请,并不用于限定本申请,并且在不冲突的情况下,本申请中的实施例及实施例中的特征可以相互组合。

参见图1,图1示出了本申请实施例提供的车辆自动换道的示意图,图1中为车辆设定的在车道中的相对行驶位置为车道中心,假设车辆一直沿着中间的车道自动行驶。实际应用中,为了了解前方车道信息,自动行驶的车辆都会实时采集前方图像,当需要进行换道时,可将换道方向信息,如向左或者向右的换道信息,发送给车辆,车辆在接收到换道请求后,可根据换道方向信息、采集到的前方图像和当前的车速预测到达换道终点时车辆的运动状态,如车辆的坐标和航向角。

进一步地,为车辆规划第i时刻的换道线路和车速,其中,第i时刻的换道线路和车速是以第i时刻车辆的运动状态为起始运动状态、预测的运动状态为目标运动状态进行规划得到的,进而根据第i时刻换道线路的曲率、车速和建立的用于确定方向盘转角的模型,确定第i时刻车辆的方向盘转角,i为大于或者等于0的整数;

判断第i时刻车辆的方向盘转角是否落入有效的方向盘转角范围内,该有效的方向盘转角范围是根据换道起点的位置和换道终点的位置确定的,若否,则返回为车辆规划第i时刻的换道线路和车速的步骤,若是,则根据车辆运动模型、第i时刻车辆的运动状态和方向盘转角,确定第i+1时刻车辆的运动状态;

判断第i+1时刻车辆的运动状态与目标运动状态之间的误差是否大于预设误差,若是,则将i更新为i+1,并返回为车辆规划第i时刻的换道线路和车速的步骤,即继续规划下一时刻的换道线路和车;若否,则根据为车辆规划的各时刻的换道线路和车速驱动车辆进行换道。

本申请实施例中,在进行换道时,可先根据换道起点和换道终点的位置确定有效的方向盘转角范围,之后,周期性地为车辆规划换道线路和车速,且保证车辆以每次规划的换道线路和车速进行行驶时,车辆的方向盘转角都落在有效的方向盘转角范围内,因此,可避免由于方向盘转角过大而导致换道不成功的情况,并且,利用车辆运动模型来迭代确定各时刻车辆的运动状态可更好地保证换道过程中方向盘转动的平顺性,用户体验也更好。

下面结合具体的实施例对上述过程进行详细说明。

结合图1,假设车辆接收到的换道请求中携带的换道方向信息为向左换道,则可按照图2所示的流程预测结束换道时车辆的运动状态:

S201:根据换道方向信息确定换道结束后车辆行驶的车道。

S202:从已采集到的每一前方图像中提取车道左右两侧车道线的图像信息,根据提取的左右两侧车道线的图像信息和为车辆设定的在车道中的相对行驶位置信息,确定沿车道行驶时为车辆规划的行驶线路的数学表达式。

具体实施时,可利用多项式对车道线进行拟合,比如,用于拟合右侧车道线的多项式为:

yleft1=al10+al11·x+al12·x2+al13·x3

用于拟合左侧车道线的多项式为:

yleft2=al20+al21·x+al22·x2+a123·x3

则,确定右侧车道线的数学表达式即是根据右侧车道线的图像信息确定al10、al11、al12、al13的取值;确定左侧车道线的数学表达式即是根据左侧车道线的图像信息确定al20、al21、al22、a123的取值。

如果为车辆设定的在车道中的相对行驶位置为车道中心,则当车辆沿换道后车道行驶时为其规划的行驶线路的数学表达式为:

Figure BDA0001728317140000061

S203:将当前车速输入到预先拟合的用于确定换道距离的模型中,以模型的输出作为此次换道所需的距离。

这里,发明人通过分析车速-换道距离点集发现,采用三次多项式拟合能够较好地反应二者之间的关系,因此,本申请实施例中采用三次多项式对车速-换道之间的关系进行拟合,得到如下的换道距离与车速的关系曲线:

Dis_LC=a0+a1v+a2v2+a3v3

其中,a0,a1,a2,a3是通过离线仿真数据确定的三次多项式的系数。

具体实施时,将当前车速代入上式则可计算出此次换道所需的距离。

S204:根据行驶线路的数学表达式和此次换道所需的距离确定到达换道终点时车辆的运动状态。

具体地,求解如下方程组即可得到换道终点的坐标(xf,yf):

其中,l为此次换道所需的距离,(x0,y0)为换道开始时车辆的坐标。

之后,可对

Figure BDA0001728317140000071

进行一阶求导,并计算一阶导函数在(xf,yf)处的取值,将该取值作为换道结束时车辆的航向角。

此外,还可对

Figure BDA0001728317140000072

进行二阶求导,并计算二阶导函数在(xf,yf)处的取值,将该取值作为为车辆规划的最后一段换道线路的目标曲率。

需要说明的是,上述步骤S202和S203之间没有严格的先后执行关系。

具体实施时,在预测车辆到达换道终点时的运动状态以后,可将路径生成问题描述为如下方程的求解问题:

Figure BDA0001728317140000073

其中:

Figure BDA0001728317140000074

为车辆在换道起点时的运动状态(x0,y00,k0),(x0,y0)为换道起点的位置坐标,θ0为车辆在换道起点时的航向角;k0为在换道起点处(对应i=0时的时刻)为车辆规划的换道线路的曲率,θ0,k0均是预先确定的;

Figure BDA0001728317140000075

为车辆在换道终点时的运动状态(xf,yff,kf),(xf,yf)为换道终点的位置坐标,θf为车辆在换道终点时的航向角;k0是为车辆规划的最后一段换道线路的目标曲率;

U为待求解的为车辆规划的换道线路的曲率,其随时间不断发生变化;

Figure BDA0001728317140000076

为车辆运动模型。

首先,本申请实施例中将U描述为一个随时间变化的三次多项式:

U=c0+c1t+c2t2+c3t3,t∈[0,T];

其中,需要求解的参数为c0、c1、c2、c3,T为总的换道时间。

这里,采用三次多项式来描述U有两个好处,一是可以减少目标输入求解空间的范围;二是可使换道线路更加平顺,因为三次多项式已经能够覆盖较高阶次的换道线路的曲率。

其次,本申请实施例中,

Figure BDA0001728317140000081

可通过车辆二自由度运动模型来构造,如图3所示,以x(t)代表质心侧偏角和横摆角速度,u(t)代表前轮转角,则车辆的二自由度模型可以表示为:

Figure BDA0001728317140000082

Figure BDA0001728317140000083

Figure BDA0001728317140000084

Figure BDA0001728317140000085

Figure BDA0001728317140000086

Figure BDA0001728317140000087

其中:

m为车辆质量;

Iz为横摆转动惯量;

v为车速;

kf为前轮的轮胎侧片刚度;

kr为后轮的轮胎侧片刚度;

lf为前轴到车辆重心的距离;

lr为后轴到车辆重心的距离;

β为质心侧偏角;

ωr为横摆角速度;

δh为转向盘转角;

is为转向传动比;

为车辆横摆角。

车辆运动学方程可以表述为:

Figure BDA0001728317140000092

Figure BDA0001728317140000093

Figure BDA0001728317140000094

因此,最终得到的车辆运作模型为:

δh=U·(1+K·v2)·L·is

Figure BDA0001728317140000096

其中,(xv,yv)为车辆的位置坐标。

最后,求解公式

Figure BDA0001728317140000097

由于上式为非线性方程,因此可通过解析法获得换道线路的曲率U,具体地求解过程如下:

Figure BDA0001728317140000098

其中,

Figure BDA0001728317140000099

UK=c0k+c1kt+c2kt2+c3kt3,t=0~Tk,k为代次数,Tk第k次迭代时的换道时间,ΔU为迭代过程中Uk的增量,

Figure BDA00017283171400000910

J为雅克比矩阵;

通过上述迭代求解,当满足

Figure BDA00017283171400000911

(eiter为迭代终止误差)时,迭代结束,其对应的Uk+1的值即为最终求解的目标路径,换道线路规划结果如图4所示,其中,两条虚线都为换道线路,这两条换道线路具有相同的换道起点和换道终点,但由于起始时车辆的航向角不同,所以规划的换道线路也不相同。

如图5所示,为本申请实施例提供的车辆的自动换道方法的流程图,包括以下步骤:

S501:处于自动驾驶状态的车辆接收换道请求,该换道请求中携带有换道方向信息。

S502:根据换道方向信息、采集到的前方图像和当前的车速预测到达换道终点时车辆的运动状态。

具体流程可以参考图2,在此不再赘述。

S503:将代表规划时刻的i赋值为0。

S504:以第i时刻车辆的运动状态为起始运动状态、预测的车辆的运动状态为目标运动状态,为车辆规划第i时刻的换道线路和车速,根据第i时刻换道线路的曲率、车速和建立的用于确定方向盘转角的模型,确定第i时刻车辆的方向盘转角。

这里,可以开始换道时的时刻为0时刻,即,i为从0开始的整数,然后以设定时间间隔如Δt进行递增,当到达换道终点时,i的递增结束,这样,可得到换道所需的总时间T。

具体实施时,可以根据第i时刻车辆的位置和换道终点位置随机地为车辆规划出一条换道线路,然后根据换道线路的长度和Δt计算第i时刻的车速,之后,将第i时刻为车辆规划的换道线路的曲率U和车速v代入以下公式:

δh=U·(1+K·v2)·L·is

得到第i时刻车辆的方向盘转角δh

其中,L为车辆前轴与后轴之间的距离,is为车辆的转向传动比,K为预先确定的转向因子,且可根据以下公式计算:

其中,m为车辆质量;kf为前轮的轮胎侧片刚度;kr为后轮的轮胎侧片刚度;lf为前轴到车辆重心的距离;lr为后轴到车辆重心的距离。

S505:判断第i时刻车辆的方向盘转角是否落入设置的有效的方向盘转角范围内,若是,则进入S506,否则,进入S504重新为车辆规划第i时刻的换道线路和车速。

这里,有效的方向盘转角范围是根据换道起点的位置和换道终点的位置确定的,比如,换道起点的坐标为(x0,y0),换道终点的坐标为(xf,yf),若向左换道,则有效的方向盘转角范围可为(0°,1.2arc tanα),若向右换道,则有效的方向盘转角范围可为(-1.2arctanα,0°),其中,

Figure BDA0001728317140000111

这里仅是举例,具体范围可由技术人员根据实际情况确定。

具体实施时,若确定需要重新为车辆规划第i时刻的换道线路和车速,则可根据一定的规则对上一次规划的换道路径的曲率进行微调,比如,减去设定量等。

S506:根据车辆运动模型、第i时刻车辆的运动状态和方向盘转角,确定第i+1时刻车辆的运动状态。

在具体实施时,可将第i时刻车辆的方向盘转角代入车辆运动模型,以车辆运动模型的输出作为车辆运动状态的增量,将第i时刻车辆的运动状态与该增量的和确定为第i+1时刻车辆的运动状态。

具体地,可根据以下的车辆运动模型预测第i+1时刻车辆的运动状态:

其中,各参数的含义同前,在此不再赘述。

S507:计算第i+1时刻车辆的运动状态与目标运动状态之间的误差,判断误差是否小于预设误差,若是,则进入S509,否则,进入S508。

比如,利用以下公式计算误差:

err=(yf-yi+1)2+(xf-xi+1)2+(θfi+1)2

其中,(xi+1,yi+1i+1)为i+1时刻车辆的运动状态。

当确定err小于预设误差时,可认为车辆的运动状态以足够接近目标运动状态,否则,可继续进行下一时刻的路径规划。

S508:将i=i+1,返回步骤S504,继续规划下一时刻的换道线路和车速。

S509:根据为车辆规划的各时刻的换道线路和车速驱动车辆进行自动换道。

经过以上过程,为车辆规划出了从换道起点开始每隔Δt时刻车辆的换道线路和车速,根据各时刻为车辆规划的换道线路和车速即可驱动车辆进行自动换道。

此外,具体实施时,在预测车辆到达终点时的运动状态时,还为车辆规划最后一段换道线路的目标曲率,为了保证换道的精确度,在确定第i+1时刻车辆的运动状态与目标运动状态之间的误差小于预设误差时,还可以进一步确定为车辆规划的第i时刻的换道线路的曲率与目标曲率之间的误差小于预设值,这样,车辆在到完成换道后即可沿着车道自动行驶,换道的平顺性更好。

下面结合具体的实施例对上述过程进行说明。

假设自动驾驶状态的车辆接收到了向左换道的请求,则可从已采集到的每一前方图像中提取左侧车道对应的左右两侧车道线的图像信息,进而根据提取的左右两侧车道线的图像信息和为车辆设定的在左侧车道中的相对行驶位置信息,确定沿左侧车道行驶时为车辆规划的行驶线路的数学表达式,并可将当前车速输入到预先拟合的用于确定换道距离的模型中,以模型的输出作为此次换道所需的距离,进而根据行驶线路的数学表达式和此次换道所需的距离确定到达换道终点时车辆的运动状态以及为车辆规划的最后一段换道线路的目标曲率。

之后,从换道起点开始,每隔预设时长,如1s,为车辆规划一次换道线路和车速,针对每次为车辆规划的换道线路和车速,确定车辆以规划的车速沿换道线路进行换道时车辆的方向盘转角落在有效的方向盘转角范围内时,可根据车辆运动模型、第i时刻车辆的运动状态和方向盘转角,确定第i+1时刻车辆的运动状态,并计算第i+1时刻车辆的运动状态与预测的到达换道终点时车辆的运动状态之间的误差,以及为车辆规划的第i+1时刻换道线路的曲率和目标曲率之间的误差,计算两个误差之和,判断误差之和是否小于设定的误差,若否,则将i更新为i+1,继续进行下一时刻的换道线路和车速,否则,可认为第i+1时刻车辆的运动状态已达到预测的到达换道终点时车辆的运动状态,路径规划结束。

之后,即可根据各时刻为车辆规划的换道线路和车速驱动车辆进行自动换道。

参见图6所示,为本申请实施例提供的一种电子设备的结构示意图,该电子设备包括收发器601以及处理器602等物理器件,其中,处理器602可以是一个中央处理单元(central processing unit,CPU)、微处理器、专用集成电路、可编程逻辑电路、大规模集成电路、或者为数字处理单元等等。收发器601用于电子设备和其他设备进行数据收发。

该电子设备还可以包括存储器603用于存储处理器602执行的软件指令,当然还可以存储电子设备需要的一些其他数据,如电子设备的标识信息、电子设备的加密信息、用户数据等。存储器603可以是易失性存储器(volatile memory),例如随机存取存储器(random-access memory,RAM);存储器503也可以是非易失性存储器(non-volatilememory),例如只读存储器(read-only memory,ROM),快闪存储器(flash memory),硬盘(hard disk drive,HDD)或固态硬盘(solid-state drive,SSD)、或者存储器603是能够用于携带或存储具有指令或数据结构形式的期望的程序代码并能够由计算机存取的任何其他介质,但不限于此。存储器603可以是上述存储器的组合。

本申请实施例中不限定上述处理器602、存储器603以及收发器601之间的具体连接介质。本申请实施例在图6中仅以存储器603、处理器602以及收发器601之间通过总线604连接为例进行说明,总线在图6中以粗线表示,其它部件之间的连接方式,仅是进行示意性说明,并不引以为限。所述总线可以分为地址总线、数据总线、控制总线等。为便于表示,图6中仅用一条粗线表示,但并不表示仅有一根总线或一种类型的总线。

处理器602可以是专用硬件或运行软件的处理器,当处理器602可以运行软件时,处理器602读取存储器603存储的软件指令,并在所述软件指令的驱动下,执行前述实施例中的自动换道方法。

当本申请实施例中提供的方法以软件或硬件或软硬件结合实现的时候,电子设备中可以包括多个功能模块,每个功能模块可以包括软件、硬件或其结合。具体的,参见图7所示,为本申请实施例提供的又一种电子设备的结构示意图,该电子设备包括接收模块701,预测模块702、规划模块703、驱动模块704。

接收模块701,用于处于自动驾驶状态的车辆接收换道请求,所述换道请求中携带有换道方向信息;

预测模块702,用于根据所述换道方向信息、采集到的前方图像和当前的车速预测到达换道终点时所述车辆的运动状态;

规划模块703,用于为所述车辆规划第i时刻的换道线路和车速,其中,第i时刻的换道线路和车速是以第i时刻所述车辆的运动状态为起始运动状态、预测的所述车辆的运动状态为目标运动状态进行规划得到的,根据第i时刻换道线路的曲率、车速和建立的用于确定方向盘转角的模型,确定第i时刻所述车辆的方向盘转角,判断第i时刻所述车辆的方向盘转角是否落入有效的方向盘转角范围内,所述有效的方向盘转角范围是根据换道起点的位置和所述换道终点的位置确定的,若否,则返回为所述车辆规划第i时刻的换道线路和车速的步骤,若是,则根据车辆运动模型、第i时刻所述车辆的运动状态和方向盘转角,确定第i+1时刻所述车辆的运动状态,i为大于或者等于0的整数;

驱动模块704,用于判断第i+1时刻所述车辆的运动状态与所述目标运动状态之间的误差是否大于预设误差,若是,则将i更新为i+1,并返回为所述车辆规划第i时刻的换道线路和车速的步骤;若否,则根据为所述车辆规划的各时刻的换道线路和车速驱动所述车辆进行换道。

在一种可能的实施方式下,所述预测模块702具体用于,

根据所述换道方向信息确定换道结束后所述车辆行驶的车道;

从已采集到的每一前方图像中提取所述车道左右两侧车道线的图像信息,根据提取的左右两侧车道线的图像信息和为所述车辆设定的在车道中的相对行驶位置信息,确定沿所述车道行驶时为所述车辆规划的行驶线路的数学表达式;并

将所述车速输入到预先拟合的用于确定换道距离的模型中,以所述模型的输出作为此次换道所需的距离;

根据确定的所述行驶线路的数学表达式和所述此次换道所需的距离确定到达换道终点时所述车辆的运动状态。

在一种可能的实施方式下,所述预测模块702具体用于,

根据提取的每侧车道线的图像信息确定该侧车道线的数学表达式;

根据左右两侧车道线的数学表达式和为所述车辆设定的在车道中的相对行驶位置信息,确定沿所述车道行驶时为所述车辆规划的行驶线路的数学表达式。

在一种可能的实施方式下,所述车辆的运动状态包括所述车辆的坐标和航向角,所述预测模块702具体用于,

根据所述行驶线路的数学表达式和所述此次换道所需的距离确定换道终点的坐标;

对所述行驶线路的数学表达式求一阶导函数,计算所述一阶导函数在所述坐标处的取值,将所述取值作为达到换道终点时所述车辆的航向角。

在一种可能的实施方式下,所述预测模块702,还用于对所述行驶线路的数学表达式求二阶导函数,计算所述二阶导函数在所述坐标处的取值,将所述取值作为为所述车辆规划的最后一段换道线路的目标曲率;

所述驱动模块704,还用于在确定第i+1时刻所述车辆的运动状态与所述目标运动状态之间的误差小于预设误差时,确定为所述车辆规划的第i时刻的换道线路的曲率与所述目标曲率之间的误差小于预设值。

在一种可能的实施方式下,所述规划模块703具体用于,

将第i时刻换道线路的曲率U、车速v代入以下公式:

δh=U·(1+K·v2)·L·is

得到第i时刻所述车辆的方向盘转角δh

其中,L为所述车辆前轴与后轴之间的距离,is为所述车辆的转向传动比,K为预先确定的转向因子。

本申请实施例中对模块的划分是示意性的,仅仅为一种逻辑功能划分,实际实现时可以有另外的划分方式,另外,在本申请各个实施例中的各功能模块可以集成在一个处理器中,也可以是单独物理存在,也可以两个或两个以上模块集成在一个模块中。各个模块相互之间的耦合可以是通过一些接口实现,这些接口通常是电性通信接口,但是也不排除可能是机械接口或其它的形式接口。因此,作为分离部件说明的模块可以是或者也可以不是物理上分开的,既可以位于一个地方,也可以分布到同一个或不同设备的不同位置上。上述集成的模块既可以采用硬件的形式实现,也可以采用软件功能模块的形式实现。

本申请实施例还提供了一种计算机可读存储介质,存储为执行上述处理器所需执行的计算机可执行指令,其包含用于执行上述处理器所需执行的程序。

在一些可能的实施方式中,本申请提供的车辆的自动换道方法的各个方面还可以实现为一种程序产品的形式,其包括程序代码,当所述程序产品在电子设备上运行时,所述程序代码用于使所述电子设备执行本说明书上述描述的根据本申请各种示例性实施方式的车辆的自动换道方法中的步骤。

所述程序产品可以采用一个或多个可读介质的任意组合。可读介质可以是可读信号介质或者可读存储介质。可读存储介质例如可以是——但不限于——电、磁、光、电磁、红外线、或半导体的系统、装置或器件,或者任意以上的组合。可读存储介质的更具体的例子(非穷举的列表)包括:具有一个或多个导线的电连接、便携式盘、硬盘、随机存取存储器(RAM)、只读存储器(ROM)、可擦式可编程只读存储器(EPROM或闪存)、光纤、便携式紧凑盘只读存储器(CD-ROM)、光存储器件、磁存储器件、或者上述的任意合适的组合。

本申请的实施方式的用于车辆自动换道的程序产品可以采用便携式紧凑盘只读存储器(CD-ROM)并包括程序代码,并可以在计算设备上运行。然而,本申请的程序产品不限于此,在本文件中,可读存储介质可以是任何包含或存储程序的有形介质,该程序可以被指令执行系统、装置或者器件使用或者与其结合使用。

可读信号介质可以包括在基带中或者作为载波一部分传播的数据信号,其中承载了可读程序代码。这种传播的数据信号可以采用多种形式,包括——但不限于——电磁信号、光信号或上述的任意合适的组合。可读信号介质还可以是可读存储介质以外的任何可读介质,该可读介质可以发送、传播或者传输用于由指令执行系统、装置或者器件使用或者与其结合使用的程序。

可读介质上包含的程序代码可以用任何适当的介质传输,包括——但不限于——无线、有线、光缆、RF等等,或者上述的任意合适的组合。

可以以一种或多种程序设计语言的任意组合来编写用于执行本申请操作的程序代码,所述程序设计语言包括面向对象的程序设计语言—诸如Java、C++等,还包括常规的过程式程序设计语言—诸如“C”语言或类似的程序设计语言。程序代码可以完全地在用户计算设备上执行、部分地在用户设备上执行、作为一个独立的软件包执行、部分在用户计算设备上部分在远程计算设备上执行、或者完全在远程计算设备或服务器上执行。在涉及远程计算设备的情形中,远程计算设备可以通过任意种类的网络——包括局域网(LAN)或广域网(WAN)—连接到用户计算设备,或者,可以连接到外部计算设备(例如利用因特网服务提供商来通过因特网连接)。

应当注意,尽管在上文详细描述中提及了装置的若干单元或子单元,但是这种划分仅仅是示例性的并非强制性的。实际上,根据本申请的实施方式,上文描述的两个或更多单元的特征和功能可以在一个单元中具体化。反之,上文描述的一个单元的特征和功能可以进一步划分为由多个单元来具体化。

此外,尽管在附图中以特定顺序描述了本申请方法的操作,但是,这并非要求或者暗示必须按照该特定顺序来执行这些操作,或是必须执行全部所示的操作才能实现期望的结果。附加地或备选地,可以省略某些步骤,将多个步骤合并为一个步骤执行,和/或将一个步骤分解为多个步骤执行。

本领域内的技术人员应明白,本申请的实施例可提供为方法、系统、或计算机程序产品。因此,本申请可采用完全硬件实施例、完全软件实施例、或结合软件和硬件方面的实施例的形式。而且,本申请可采用在一个或多个其中包含有计算机可用程序代码的计算机可用存储介质(包括但不限于磁盘存储器、CD-ROM、光学存储器等)上实施的计算机程序产品的形式。

本申请是参照根据本申请实施例的方法、装置(系统)、和计算机程序产品的流程图和/或方框图来描述的。应理解可由计算机程序指令实现流程图和/或方框图中的每一流程和/或方框、以及流程图和/或方框图中的流程和/或方框的结合。可提供这些计算机程序指令到通用计算机、专用计算机、嵌入式处理机或其他可编程数据处理设备的处理器以产生一个机器,使得通过计算机或其他可编程数据处理设备的处理器执行的指令产生用于实现在流程图一个流程或多个流程和/或方框图一个方框或多个方框中指定的功能的装置。

这些计算机程序指令也可存储在能引导计算机或其他可编程数据处理设备以特定方式工作的计算机可读存储器中,使得存储在该计算机可读存储器中的指令产生包括指令装置的制造品,该指令装置实现在流程图一个流程或多个流程和/或方框图一个方框或多个方框中指定的功能。

这些计算机程序指令也可装载到计算机或其他可编程数据处理设备上,使得在计算机或其他可编程设备上执行一系列操作步骤以产生计算机实现的处理,从而在计算机或其他可编程设备上执行的指令提供用于实现在流程图一个流程或多个流程和/或方框图一个方框或多个方框中指定的功能的步骤。

尽管已描述了本申请的优选实施例,但本领域内的技术人员一旦得知了基本创造性概念,则可对这些实施例作出另外的变更和修改。所以,所附权利要求意欲解释为包括优选实施例以及落入本申请范围的所有变更和修改。

显然,本领域的技术人员可以对本申请进行各种改动和变型而不脱离本申请的精神和范围。这样,倘若本申请的这些修改和变型属于本申请权利要求及其等同技术的范围之内,则本申请也意图包含这些改动和变型在内。

20页详细技术资料下载
上一篇:一种医用注射器针头装配设备
下一篇:一种铝合金底架结构

网友询问留言

已有0条留言

还没有人留言评论。精彩留言会获得点赞!

精彩留言,会给你点赞!