一种车辆控制方法和装置与流程

文档序号:15949695发布日期:2018-11-14 05:03阅读:184来源:国知局
一种车辆控制方法和装置与流程
本申请涉及无人车
技术领域
,尤其涉及一种车辆控制方法和装置。
背景技术
无人车是根据全部或部分已知和实时获取的环境条件信息做出相应的全局或局部路径规划,并自动地作出控制决策,使车辆安全可靠的运行至预定的目的地的智能汽车。车辆控制技术是无人车技术的核心,主要包括车辆的速度和方向控制等几个部分,通过速度和方向控制,能够实现车辆行驶路线的控制。现有的车辆控制方法通过鲁棒pid(proportion、integration、differential,比例、积分、微分)方法计算控制量,根据该控制量可以控制车辆的实际行进路线不断趋近车辆的期望行进路线,直至实际行进路线与期望行进路线重合。然而,鲁棒pid方法是一种线性控制方法,因此该方法只能以线性方法确定车辆的控制量,从而根据控制量对车辆进行控制时,无论车辆当前实际行进路线偏离期望行进路线的程度如何,车辆向期望行进路线趋近的收敛速度都是相同的,控制效果不理想。技术实现要素:本申请提供一种车辆控制方法和装置,用以解决目前的车辆控制方法控制车辆行进路线时效果不理想的技术问题。第一方面,本申请实施例提供一种车辆控制方法,首先根据目标车辆的状态信息以及目标车辆所处道路的路面信息,确定当前的横向位移偏差以及横向角度偏差,其中,当前的横向位移偏差用于表示目标车辆当前时刻所处的目标位置与道路对应的目标路径上的第一横向位置之间的距离,横向角度偏差用于表示目标车辆当前时刻的行进方向与目标路径在第一横向位置的切线方向之间的角度偏差,第一横向位置为目标路径上与目标位置之间的距离最小的位置,横向角度偏差小于或等于90度,目标路径为期望目标车辆行驶的路径;此后,根据当前的横向位移偏差、横向角度偏差以及预瞄距离,确定预瞄位置的横向位移偏差,其中,预瞄位置的横向位移偏差用于表示目标车辆行驶至预瞄位置时,预瞄位置与位于目标路径上的第二横向位置之间的距离,预瞄位置在目标车辆的中轴线上的投影位置与目标位置之间的距离为预瞄距离,且从目标位置指向预瞄位置之间的矢量方向与目标车辆当前的行进方向之间的夹角小于九十度,第二横向位置为目标路径上与预瞄位置之间的距离最小的位置;之后,根据当前的横向位移偏差、横向角度偏差、预瞄位置的横向位移偏差、滑模切换面方程以及滑模控制参数,确定滑模控制率,最后通过滑模控制方法,将滑模控制率作为输入,确定输出的转向角并根据转向角控制目标车辆,该转向角用于将目标车辆调整至沿目标路径行驶。采用以上方法,通过滑模控制方法实现对目标车辆行驶路线的控制,使得目标车辆的行驶路线趋近目标路径直至与目标路径重合,由于滑模控制方法为非线性的控制方法,使得调整目标车辆行驶轨迹的时间更短,控制效果更加理想。在实施中,可以根据第一公式确定当前的横向位移偏差yl,第一公式为:其中,表示对yl求导,vy为目标车辆在垂直目标车辆当前时刻的行进方向上的横向速度,yl为根据目标车辆的三维系统状态表达式确定的。另外,可以根据第二公式确定横向角度偏差εl,第二公式为:其中,表示对εl求导,ρ为目标路径的曲率,vx为目标车辆在目标车辆当前时刻的行进方向上的纵向速度,β为当前时刻目标车辆当前时刻的行进方向与行进方向在水平面的投影之间的夹角,yl为根据目标车辆的三维系统状态表达式确定的,w为目标车辆的横摆角速度,w为根据目标车辆的三维系统状态表达式确定的。由于在确定横向角度偏差εl时考虑到了道路与水平面之间的斜面夹角β,使得根据该横向角度偏差εl进行行驶路线拟合得到的结果更为贴近实际路况,对于目标车辆的行驶轨迹的控制效果更为理想。在实施中,目标车辆的三维系统状态表达式为:其中,u为目标车辆的转向角,表示对vy求导,表示对w求导,a11、a12、a21、a22、b11以及b21均为根据当前时刻目标车辆的状态信息以及道路的路面信息确定的系数。在实施中,可以根据第三公示确定a11,第三公式为:其中,cr为目标车辆的后轮胎的侧偏刚度,cf为目标车辆的前轮胎的侧偏刚度,m为目标车辆的质量,vx为目标车辆在目标车辆当前时刻的行进方向上的纵向速度,β为当前时刻目标车辆当前时刻的行进方向与水平面之间的夹角;可以根据第四公示确定a12,第四公式为:其中,a为目标车辆的前轮轴距,b为目标车辆的后轮轴距;可以根据第五公式确定a21,第五公式为:其中,j为目标车辆的转动惯量;可以根据第六公式确定a22,第六公式为:可以根据第七公式确定b11,第七公式为:可以根据第七公式确定b21,第八公式为:在实施中,可以根据第九公式,确定预瞄距离d,第九公式为:其中,d0为设定距离值,v为目标车辆的行驶速度,ρfront为第一曲率,ρnext为第二曲率。其中,第一曲率为目标路径在第一横向位置的曲率、目标路径在第一预瞄点的曲率以及目标路径在第一横向位置与第一预瞄点之间的平均曲率,第二曲率为目标路径在第一横向位置的曲率、目标路径在第二预瞄点的曲率以及目标路径在第一横向位置与第二预瞄点之间的平均曲率,第一预瞄点为目标路径上与目标位置之间的距离大于设定距离值的点中,与目标位置之间的距离最小的点,从目标位置发出且指向第一预瞄点的矢量与目标车辆当前时刻的行进方向之间的夹角小于九十度,第二预瞄点为目标路径上与目标位置之间的距离大于设定距离值的点中,与目标位置之间的距离最小的点,从目标位置发出且指向第二预瞄点的矢量与目标车辆当前时刻的行进方向之间的夹角不小于九十度。在实施中,可以根据第十公式,确定预瞄位置的横向位移偏差ye:其中,r为目标路径的转向半径,d为预瞄距离,yl为当前的横向位移偏差,εl为横向角度偏差。在实施中,可以构建如下滑模切换面方程:其中,ye为预瞄位置的横向位移偏差,α、βs以及(q/p)为滑模控制参数,α、βs以及(q/p)为正奇数;令以上s1=0,可以根据第十一公式确定滑模控制参数u,第十一公式为:其中,g(x)=1/((r+yl-dsinεl)vy),f(x)=2(r-dsinεl)(a11vy+a12w)+2d(ρvxcosβ-w)cosεl,r为目标路径的转向半径,d为预瞄距离,yl为当前的横向位移偏差,εl为横向角度偏差,vx为目标车辆在目标车辆当前时刻的行进方向上的纵向速度,vy为目标车辆在垂直目标车辆当前时刻的行进方向上的横向速度,w为目标车辆的横摆角速度,a11、a12为根据当前时刻目标车辆的状态信息以及道路的路面信息确定的系数。在实施中,在控制目标车辆行驶后,还可以通过深度学习方法,确定滑模控制参数的调整值;具体来说,可以确定损失函数,用于表示目标车辆的预测行驶路径与实际行驶路径之间的实际损失,根据该损失函数,确定滑模控制参数的调整值。其中,确定损失函数的方法为:根据至少一个采样时刻目标车辆的预测横向位移偏差与实际横向位移偏差之间的偏差量,确定损失函数;或者根据至少一个采样时刻目标车辆的预测横向角度偏差与实际横向角度偏差之间的偏差量,确定损失函数。其中,预测横向位移偏差用于表示任意采样时刻,目标车辆所处的第一预测位置与目标路径上的第三横向位置之间的距离,第三横向位置为目标路径上与第一预测位置之间的距离最小的位置;实际横向位移偏差用于表示采样时刻,目标车辆所处的实际位置与目标路径上的第四横向位置之间的距离,第四横向位置为目标路径上与实际位置之间的距离最小的位置;预测横向角度偏差用于表示任意采样时刻,目标车辆的预测行进方向与目标路径在第五横向位置的切线方向之间的角度偏差,第五横向位置为目标路径上与目标车辆所处的第二预测位置之间的距离最小的位置;实际横向角度偏差用于表示采样时刻,目标车辆的实际行进方向与目标路径在第五横向位置的切线方向之间的角度偏差,第五横向位置为目标路径上与目标车辆所处的第二预测位置之间的距离最小的位置。在实施中,确定损失函数之前,可以根据第十二公式确定采样时刻目标车辆的卷积特征图cx,第十二公式为:cx=f(∑igx+bx),其中,i为输入阵,用于表示采样时刻目标车辆的状态信息以及目标车辆所处道路的路面信息,gx为可训练卷积核,bx为可训练偏置,gx的初始值为第一随机值,bx的初始值为第二随机值;根据卷积特征图cx,确定采样时刻目标车辆的预测横向位移偏差。另外在实施中,也可以根据卷积特征图cx,确定采样时刻目标车辆的预测横向角度偏差。在实施中,还可以通过梯度下降法,调整gx和/或bx。具体来说,可以根据第十三公式确定灵敏度ωx,第十三公式为:ωx=wx+1(σ'(wx+1cx+bx+1)ψi-1),其中,wx+1表示卷积核中乘性偏置的取值,σ'(wx+1cx+bx+1)表示灵敏度函数,ψi-1为输入阵的上采样;灵敏度函数为:根据第十四公式确定gx的权值更新δwx,第十四公式为:δwx=-η∑(ωxψi+1),其中,η表示学习速率,ψi+1为输入阵的下采样;根据gx的权值更新δwx,调整gx的取值。在实施中,可以根据第十五公式确定滑模控制参数α、βs以及(q/p)的调整值,第十五公式为:其中,f(q,k)表示α的权重因子、f(q,ε)表示βs的权重因子、f(q,q/p)表示(q/p)的权重因子,n表示α的可变化范围,m表示βs的可变化范围,g表示q/p的可变化范围,γa为增益系数,s,z,c1,c2分别为一大于零的常数,δα为α的调整值,δβs为βs的调整值,δ(q/p)为(q/p)的调整值。根据滑模控制参数α、βs以及(q/p)的调整值能够对滑模控制率进行调整,根据调整后的滑模控制率确定出的转向角控制目标车辆,能够进一步使得目标车辆的行驶轨迹快速趋近目标路径。第二方面,本申请实施例提供了一种车辆控制的控制设备,包括存储器和处理器,存储器存储有计算机程序或指令,处理器调用存储器存储的计算机程序或指令可以实现上述第一方面以及第一方面中的任意一种可能的设计中缓存策略服务器所执行的方法。第三方面,本申请实施例提供了一种计算机可读存储介质,可读存储介质中保存有计算机程序,当计算机程序被计算机运行时,可以使得计算机实现上述第一方面以及第一方面中的任意一种可能的设计中的车辆控制方法。第四方面,本申请实施例提供了一种计算机程序产品,当计算机程序产品被计算机运行时,可以使得计算机实现上述第一方面以及第一方面中的任意一种可能的设计中的车辆控制方法。第五方面,本申请实施例提供了一种芯片,该芯片与收发器耦合,用于实现上述第一方面以及第一方面中的任意一种可能的设计中的车辆控制方法。附图说明图1为本申请实施例提供的一种车辆控制方法的系统架构示意图;图2为本申请实施例提供的一种控制设备的结构示意图;图3为本申请实施例提供的一种目标车辆的行驶状态示意图;图4为本申请实施例提供的一种车辆控制方法的流程图;图5为本申请实施例提供的一种调整滑膜控制参数的方法的流程图;图6为本申请实施例提供的另一种车辆控制方法的流程图;图7为本申请实施例提供的另一种控制设备的结构示意图。具体实施方式本发明实施例提供一种媒体内容缓存方法和装置,用于解决鲁棒pid方法控制车辆行驶轨迹时,控制效果不理想的技术问题。下面对本申请实施例涉及的几个概念进行介绍:车辆的状态信息,是指车辆自身的参数和车辆行驶中的行驶参数,其中,车辆自身的参数包括但不限于以下参数:车辆的质量、车辆的转动惯量、车辆的前轮轴距、车辆的后轮轴距、车辆的前轮侧偏刚度、车辆的后轮侧偏刚度;车辆行驶中的行驶参数包括但不限于以下参数:车辆所处的位置信息、车辆的行驶速度、车辆的行进方向、车辆的横摆角速度、车辆前轮转角等等,其中,可以将车辆质心发出的指向车头中间位置的矢量所指向的方向作为车辆的行进方向,将车辆质心的位置作为车辆所处的位置。道路的路面信息,是指车辆行驶的道路的信息,包括但不限于以下参数:道路的位置信息(例如道路的坐标)、道路的宽度信息、道路的行进方向、道路的曲率、道路的转向半径以及道路的倾斜角(道路的行进方向与道路的行进方向在水平面的投影之间的夹角)等等。其中,可以将位于道路中的目标路径的位置信息作为道路的位置信息,将目标路径的行进方向作为道路的行进方向,将目标路径的曲率作为道路的曲率,将目标路径的转向半径作为道路的转向半径,以及将目标路径的行进方向与该行进方向在水平面的投影之间的夹角作为道路的倾斜角;目标路径可以是位于车辆行驶的道路上的期望该车辆行驶的路径,例如,目标路径可以与道路的中心线重合,且目标路径的行进方向与道路的行进方向相同。为了使本申请的目的、技术方案和优点更加清楚,下面将结合附图对本申请作进一步地详细描述。如图1所示,为本申请实施例提供的一种车辆控制方法的系统100,该系统中包括受控的目标车辆101以及控制设备102,该控制设备102可以是位于受控的目标车辆101上的终端设备,也可以是能够获取受控的目标车辆101的状态信息以及目标车辆101所在道路的路面信息并对目标车辆101进行远程控制的设备,如云服务器设备等。在实施中,控制设备102可以从目标车辆101直接获取目标车辆101的信息并直接控制目标车辆101的行驶,也可以通过其他中转设备,获取目标车辆101的信息以及通过其他中转设备控制目标车辆101的行驶。应注意,这里的控制目标车辆101的行驶,可以是通过控制信号控制目标车辆101的行驶,该控制信号可以是控制设备102直接生成的,也可以是控制设备102指示其他设备生成的。如图2所示,本申请实施例提供的一种车辆控制方法的控制设备102可以包括存储器201以及处理器202,其中,例如,通过控制设备102,存储器201用于存储计算机程序或指令,处理器202用于执行存储器所存储的计算机程序或指令,使得控制设备102实现本申请实施例提供的控制数据传输的方法中控制设备102所涉及的步骤。应理解,一种实施方式中,该控制设备102可以位于受控的目标车辆上,则控制设备102通过存储器201以及处理器202实现计算能力以及控制能力,其中,计算能力用于支持控制设备102根据本申请实施例提供的车辆控制方法确定目标车辆的转向角,控制能力用于支持控制设备102控制目标车辆根据该转向角行驶。而在另一种实施方式中,该控制设备102若为远程设备,则控制设备102还需具备通信能力,具体来说,如图2所示的控制设备102还可以具备收发器203,收发器203用于控制设备102进行交互,此时收发器203可以是无线收发器,用于支持控制设备102远程获取目标车辆的信息,以及在确定转向角后远程控制目标车辆根据该转向角行驶。如图3所示为行驶中的目标车辆101的状态示意图,其中,目标车辆101的质心所在位置为m点,即目标车辆101所在位置为m,目标车辆101的中轴线为点m、n所在直线,n点位于目标车辆101的前轮轴的中间位置,矢量与目标车辆的行进方向相同,在本申请实施例中,可以通过表示目标车辆的行进方向;目标车辆101所在道路的道路中心线为曲线s0,其中,曲线s0的曲率为ρ,o点为目标车辆101的转向圆心。采用本申请实施例提供的车辆控制方法,可以用于调整目标车辆101的轨迹趋近于期望目标车辆形式的轨迹即道路中心线s0,直至目标车辆101的轨迹与道路中心线s0重合。下面,以目标车辆101所处的目标位置为m,期望目标车辆101行驶的目标路径为道路中心线s0为例,说明本申请实施例中控制设备102控制目标车辆101的方法,该方法具有如图4所示的步骤:步骤s101:控制设备102根据当前时刻目标车辆101的状态信息以及目标车辆101当前所处道路的路面信息,确定当前的横向位移偏差以及横向角度偏差,其中,当前的横向位移偏差用于表示目标车辆101当前时刻所处的目标位置m,与道路中心线s0上的第一横向位置m1之间的距离,横向角度偏差用于表示目标车辆101当前时刻的行进方向与道路中心线s0在第一横向位置m1的切线方向之间的角度偏差,m1为道路中心线s0上与目标位置之间的距离最小的位置;在实施中,横向角度偏差小于或等于90度;步骤s102:控制设备102根据当前的横向位移偏差、横向角度偏差以及预瞄距离,确定预瞄位置的横向位移偏差,预瞄位置的横向位移偏差用于表示目标车辆101行驶至预瞄位置m’时,与道路中心线s0上的第二横向位置m2之间的距离,其中,预瞄位置m’在目标车辆当前时刻的中轴线上的投影位置m”,与目标位置m之间的距离等于预瞄距离,第二横向位置m2为目标路径上的所有位置中,与预瞄位置m’之间的距离最小的位置;在实施中,可以将m”作为预瞄位置m’;步骤s103:控制设备102根据当前的横向位移偏差、横向角度偏差、预瞄位置的横向位移偏差以及滑模控制参数,确定滑模控制率;在实施中,初始确定滑模控制率时,可以将滑模控制参数配置为预设参数;步骤s104:控制设备102根据滑模控制率,确定转向角;该转向角用于将目标车辆101的行驶路线调整至沿目标路径行驶;步骤s105:控制设备102根据确定的转向角,控制目标车辆101行驶。在步骤s101的实施中,控制设备102可以根据目标车辆101的状态信息以及道路的路面信息确定三维系统状态表达式,进一步确定目标车辆101在y轴方向(垂直目标车辆101当前时刻的行进方向)的横向速度,目标车辆101在y轴方向的横向速度可以用于确定目标车辆101所在的目标位置m,与该目标路径上的第一横向位置m1之间的距离,该距离即当前的横向位移偏差;以及,控制设备102可以根据目标车辆101的三维系统状态表达式,确定车辆当前横摆角速度,确定的横摆角速度可以用于确定目标车辆101当前的行进方向与目标路径在第一横向位置的切线方向之间的角度偏差,即横向角度偏差。在实施中,控制设备102确定的目标车辆101的状态信息,包括但不限于表1所示的信息。状态信息状态信息的符号/状态信息的单位状态信息的数值(举例)质量m/kg3200转动惯量j/kg*m29500前轮轴距a/m1.2后轮轴距b/m1.7前轮侧偏刚度cf/n*rad-1190000后轮侧偏刚度cr/n*rad-1210000表1目标车辆101的状态信息表具体来说,控制装置102可以根据第一公式,确定当前的横向位移偏差yl,第一公式为:其中,表示对yl求导,vy为目标车辆101在垂直的方向上的横向速度,vy为根据所述目标车辆101的三维系统状态表达式确定的;控制装置102还可以根据第二公式确定横向角度偏差εl,第二公式为:其中,表示对εl求导,ρ为道路中心线s0的曲率,vx为目标车辆101在方向上的纵向速度,β为与在水平面的投影之间的夹角(即目标车辆101当前所在道路的斜面倾角),yl为根据所述目标车辆的三维系统状态表达式确定的,w为所述目标车辆的横摆角速度,所述w为根据所述目标车辆的三维系统状态表达式确定的。在实施中,控制装置102确定的目标车辆101的三维系统状态表达式(为便于描述,以下称为第(1)式)可以为:其中,u为目标车辆101在当前时刻的转向角,表示对vy求导,表示对w求导,a11、a12、a21、a22、b11以及b21均为根据当前时刻目标车辆101的状态信息以及目标车辆101所在道路的路面信息确定的系数。在实施中,目标车辆101的三维系统状态表达式中,a11可以由第三公式确定:其中,cr为目标车辆101的后轮胎的侧偏刚度,cf为目标车辆101的前轮胎的侧偏刚度,m为目标车辆101的质量;a12可以由第四公式确定:其中,a为所述目标车辆的前轮轴距,b为所述目标车辆的后轮轴距;a21可以由第五公式确定:其中,j为所述目标车辆的转动惯量;a22可以由第六公式确定:b11可以由第七公式确定:b12可以由第八公式确定:在实施中,将上述第三公式、第四公式、第五公式、第六公式、第七公式以及第八公式带入第(1)式即目标车辆101的三维系统状态表达式,能够分别得到的表达式以及的表达式,进一步,根据的表达式可以确定vy,以及根据的表达式可以确定w,将vy带入第一公式,能够得到yl的表达式,以及,将w带入第二公式,能够得到εl的表达式。在步骤s102的实施中,预瞄距离可以是根据设定距离值确定的,具体来说,控制设备102可以根据第九公式确定预瞄距离:其中,d0为设定距离值,v为所述目标车辆的行驶速度,ρfront为所述第一曲率,ρnext为所述第二曲率。在实施中,该预瞄距离d用于表示目标车辆101的行驶轨迹与道路中心线s0重合时,期望目标车辆101行驶的距离在方向上的距离分量。可以理解,预瞄距离d过小,可能导致目标车辆101的转向角变化率过大,容易造成目标车辆在调整行驶轨迹中的剧烈晃动;而预瞄距离d过大,可能导致目标车辆101行驶轨迹的调整过慢,调整效果不好。采用以上方法,能够动态调整预瞄距离d的取值,防止预瞄距离d的取值过大或过小而影响对目标车辆101的控制精度。以图3为例,在实施中,控制设备102可以根据以下方法确定第一曲率ρfront:第一步:选取第一预瞄点n1,该第一预瞄点n1是道路中心线s0上与m点之间的距离大于d0的点中,与m点之间的距离最近的点,且矢量与目标车辆的行进方向之间的夹角小于九十度;具体来说,这一步骤的执行中,控制设备102可以选取一个第一预备预瞄点n1x,其中第一预备预瞄点n1x所在的矢量与目标车辆的行进方向之间的夹角小于九十度,控制设备102进一步判断n1x与目标车辆当前所在的m点之间的距离sx是否大于d0,若是,则确定n1x为第一预瞄点,否则,继续选取下一个第一预备预瞄点并判断第一预备预瞄点与m点之间的距离是否大于d0;第二步:将道路中心线s0在第一横向位置m1的曲率、道路中心线s0在第一预瞄点n1的曲率,以及道路中心线s0在第一横向位置m1与第一预瞄点n1之间各点的曲率的平均值,作为第一曲率ρfront。另外在实施中,控制设备102可以根据以下方法确定第二曲率ρnext:第一步:选取第二预瞄点n2,该第二预瞄点n2为道路中心线s0上与m点之间的距离大于d0的点中,与m点之间的距离最近的点,且矢量与目标车辆的行进方向之间的夹角不小于九十度;另一种实施方式中,第一横向位置m1到第一预瞄点n1的点数,与第二预瞄点n2到第一横向位置m1的点数相同;第二步:将道路中心线s0在第一横向位置m1的曲率、道路中心线s0在第二预瞄点n2的曲率,以及道路中心线s0在第一横向位置m1与第二预瞄点n2之间各点的曲率的平均值,作为第一曲率ρfront。在步骤s102的实施中,根据几何关系,可以根据当前的横向位移偏差、横向角度偏差以及预瞄距离,确定预瞄位置的横向位移偏差。具体来说,以图3为例,控制设备102可以根据第十公式,确定预瞄位置的横向位移偏差ye:其中,r为目标路径的转向半径,d为预瞄距离,yl为当前的横向位移偏差,εl为横向角度偏差。在实施中,目标路径x点的转向半径rx与曲率ρx之间有如下关系:其中,x点为目标路径上的任意点。在步骤s102的实施中,可以设计如下滑模切换面方程(以下简称为第(2)式):其中,ye为所述预瞄位置的横向位移偏差,表示对ye求导,α、βs以及(q/p)为滑模控制参数,α、βs以及q/p为正奇数。在实施中,滑模切换面s1=0时,滑模的固有抖振最小,从而滑模控制率u可以如第十一公式表示:其中,g(x)可以由第(3)式表示:g(x)=1/((r+yl-dsinεl)vy),(3)f(x)可以由第(4)式表示:f(x)=2(r-dsinεl)(a11vy+a12w)+2d(ρvxcosβ-w)cosεl,(4)上述第十一公式、第(3)式以及第(4)式中,r为转向半径,d可以为根据第九公式确定的预瞄距离,yl为当前的横向位移偏差,εl为横向角度偏差,vx为目标车辆101在x轴方向上的纵向速度,vy为目标车辆101在y轴方向上的横向速度,w为目标车辆101的横摆角速度,a11、a12为根据目标车辆101的状态信息以及目标车辆101所处道路的所述路面信息确定的系数。在实施中a11可以根据第三公式确定,a12可以根据第四公式确定。在步骤s104的实施中,控制设备102可以将确定的滑模控制率作为滑模控制的输入变量,通过滑模控制方法确定目标车辆101的转向角,并根据确定的转向角控制目标车辆101的行驶。在步骤s105之后,控制设备102还可以,根据目标车辆101实际行驶的路径以及期望目标车辆101行驶的道路中心线s0之间的偏差,通过深度学习方法,确定滑模控制参数的调整值,并根据滑模控制参数的调整值,调整滑模控制参数,以使通过调整后的滑模控制参数控制目标车辆101的行驶路径,更为趋近道路中心线s0。具体来说,控制设备102可以根据以下方法确定滑模控制参数的调整值:通过深度学习方法,确定至少一个采样时刻目标车辆101的预测横向位移偏差e1,以及同一个采样时刻目标车辆101的实际横向位移偏差e1’;之后,根据至少一个采样时刻目标车辆101的预测横向位移偏差e1与实际横向位移偏差e1’之间的偏差量,确定损失函数f(e1,e1’),所述损失函数用于表示至少一个采样时刻目标车辆101的预测横向位移偏差与实际横向位移偏差之间的损失;根据损失函数f(e1,e1’),确定滑模控制参数的调整值,并根据滑模控制参数的调整值,调整滑模控制参数。在实施中,也可以确定至少一个采样时刻目标车辆101的预测横向角度偏差e2,以及同一个采样时刻目标车辆101的实际横向角度偏差e2’;之后,根据至少一个采样时刻目标车辆101的预测横向角度偏差e2与实际横向角度偏差e2’之间的偏差量,确定损失函数f(e2,e2’),所述损失函数用于表示至少一个采样时刻目标车辆101的预测横向位移偏差与实际横向位移偏差之间的损失;根据损失函数f(e2,e2’),确定滑模控制参数的调整值,并根据滑模控制参数的调整值,调整滑模控制参数。另外在实施中,也可以根据至少一个采样时刻目标车辆101的预测横向位移偏差与实际横向位移偏差之间的偏差量,以及同一采样时刻,目标车辆101的预测横向角度偏差与实际横向角度偏差之间的偏差量,确定损失函数。在实施中,可以通过卷积神经网络,确定采样时刻目标车辆101的横向位移偏差,和/或,确定采样时刻目标车辆101的横向角度偏差,方法如下:构建第十二公式,由于确定卷积特征图cx:cx=f(∑igx+bx),(第十二公式)其中,i为输入阵,用于表示至少一个采样时刻目标车辆101的状态信息以及目标车辆101所处道路的路面信息,gx为可训练卷积核,bx为可训练偏置,gx的初始值为第一随机值,bx的初始值为第二随机值;在实施中,目标车辆101的状态信息以及目标车辆101所处道路的路面信息包括但不限于目标车辆101的所处位置、目标车辆101的行进方向、目标车辆101的行驶速度、目标车辆101所处道路对应的目标路径的曲率、目标车辆101到目标车辆101所处道路对应的目标路径的最短距离(即采样时刻的横向位移偏差)、预瞄距离等等,根据某一时刻的输入阵,卷积神经网络可以预测目标车辆101的横向位移偏差和/或横向角度偏差;根据卷积特征图cx,能够确定所述采样时刻目标车辆101的预测横向位移偏差,和/或,确定采样时刻所述目标车辆的预测横向角度偏差。在实施中,可以多次进行卷积核的训练更新,直到卷积核收敛,此时应有最小的经验风险函数en(f);其中,f((x),yi)为某个样本的损失函数。为使损失函数最小化,可以通过梯度下降法训练卷积核。该方法思想为:若函数f(x)在某处(如n点)可微且有定义,那么该函数在此处沿着梯度相反的方向下降最快。每经过一次迭代,根据计算而得到en(f)。具体调整gx的方法,可以包括:根据第十三公式确定gx的灵敏度ωx,所述第十三公式为:ωx=wx+1(σ'(wx+1cx+bx+1)ψi-1),(第十三公式)其中,wx+1表示所述卷积核中乘性偏置的取值,σ'(wx+1cx+bx+1)表示灵敏度函数,ψi-1为输入阵i的上采样;灵敏度函数为:根据第十四公式确定gx的权值更新δwx,第十四公式为:δwx=-η∑(ωxψi+1),(第十四公式)其中,η表示学习因子,ψi+1为输入阵i的下采样;在实施中,η可以为一个百分比常数;gx的权值更新δwx,调整gx的取值。在实施中,训练gx之前,还可以先判断是否需要进行训练,例如,可以根据卷积结果与实际测量结果的偏差程度,判断是否需要继续训练卷积核。在实施中,滑模控制参数包括α、βs以及(q/p),其中,α、βs以及(q/p)为正奇数,可以根据第十五公式确定所述滑模控制参数的调整值,第十五公式为:其中,f(q,k)表示α的权重因子、f(q,ε)表示βs的权重因子、f(q,q/p)表示(q/p)的权重因子,n表示α的可变化范围,m表示βs的可变化范围,g表示q/p的可变化范围,γa为增益系数,s,z,c1,c2分别为一大于零的常数,δα为α的调整值,δβs为βs的调整值,δ(q/p)为(q/p)的调整值。采用以上方法,可以得到α、βs以及(q/p)的调整值δα、δβs以及δ(q/p),在下一次确定滑膜控制率时,可以将δα、δβs以及δ(q/p)作为滑膜控制参数。如图5所示,本申请实施例提供的一种调整滑膜控制参数的方法包括以下步骤:步骤501:对目标车辆101当前时刻的状态信息以及目标车辆101所处道路的路面信息进行卷积处理;在实施中目标车辆101在采样时刻的状态信息可以用于确定预测横向位移偏差以及预测横向角度偏差;步骤502:根据卷积处理的结果,判断是否需要更新卷积核,若是,则执行步骤503,否则,执行步骤504:在实施中,可以根据预测横向位移偏差与实际横向位移偏差之间的偏差量,和/或,根据预测横向角度偏差与实际横向角度偏差之间的偏差量,判断是否需要训练卷积核,其中,实际横向位移偏差和/或实际横向角度偏差可以是根据惯性导航方法确定的;步骤503:根据梯度下降法更新卷积核,之后执行步骤501:步骤504:根据卷积处理的结果,确定至少一个采样时刻目标车辆101的预测横向位移偏差以及预测横向角度偏差;步骤505:根据至少一个采样时刻目标车辆101的预测横向位移偏差、预测横向角度偏差、实际横向位移偏差以及实际横向角度偏差,确定损失函数;在实施中,实际横向位移偏差以及实际横向角度偏差可以是根据惯性导航确定的;步骤502:根据损失函数,确定滑膜控制参数的调整值。如图6所示,若控制设备102位于如图3所示的目标车辆101上,本申请实施例提供的一种控制车辆的方法包括以下步骤:步骤601:控制设备102获取目标车辆101的状态信息以及目标车辆101所处道路的路面信息;在实施中,目标车辆101所处道路的路面信息包括期望目标车辆101行驶的目标路径的信息;步骤602:控制设备102根据目标车辆101的状态信息以及处道路的路面信息,确定当前的横向位移偏差yl、横向角度偏差εl以及预瞄距离d;步骤603:控制设备102根据当前的横向位移偏差yl、横向角度偏差εl以及预瞄距离d,确定预瞄位置的横向位移偏差ye;步骤604:控制设备102根据预瞄位置的横向位移偏差ye以及滑模控制参数构建滑模切换面方程s1,并确定滑模控制率u;步骤605:控制设备102根据滑模控制方法,将滑模控制率u作为输入量,确定滑模控制方法的输出量,根据滑模控制方法的输出量控制目标车辆101的转向角,使得目标车辆101的行驶轨迹不断趋近目标路径。基于与上述方法实施例相同构思,本申请实施例还提供了一种控制设备,用于实现本申请实施例中控制设备102所涉及的方法,在具体实施中,该控制设备可以是用于实现上述方法的终端、云设备,或者其他具有类型功能的设备、硬件。该控制设备可以具有如图2所示的结构。如图2所示,为本申请的实施例提供的上述实施例中所涉及的控制设备102的一种可能的逻辑结构示意图中,控制设备102包括处理器202。在本申请的实施例中,处理器202用于对该控制设备102的动作进行控制管理。控制设备102还可以包括存储器201和收发器203。其中,该存储器202用于存储控制设备102的计算机程序或指令。收发器201用于支持该控制设备102进行通信。在如图2所示的控制设备102中,处理器202可以是中央处理器单元,通用处理器,数字信号处理器,专用集成电路,现场可编程门阵列或者其他可编程逻辑器件、晶体管逻辑器件、硬件部件或者其任意组合。其可以实现或执行结合本申请公开内容所描述的各种示例性的逻辑方框,模块和电路。处理器202也可以是实现计算功能的组合,例如包含一个或多个微处理器组合,数字信号处理器和微处理器的组合等等。具体来说,如图2所示的控制设备102中,收发器203,用于控制设备102进行通信;存储器201,用于存储计算机代码或指令;处理器202,用于调用存储器201中的计算机代码或指令,执行以下步骤:存储器,用于存储计算机代码或指令;处理器,用于调用存储器中的计算机代码或指令,执行以下步骤:根据目标车辆的状态信息以及目标车辆所处道路的路面信息,确定当前的横向位移偏差以及横向角度偏差,其中,当前的横向位移偏差用于表示目标车辆当前时刻所处的目标位置与道路对应的目标路径上的第一横向位置之间的距离,横向角度偏差用于表示目标车辆当前时刻的行进方向与目标路径在第一横向位置的切线方向之间的角度偏差,第一横向位置为目标路径上与目标位置之间的距离最小的位置,横向角度偏差小于或等于90度,目标路径为期望目标车辆行驶的路径;根据当前的横向位移偏差、横向角度偏差以及预瞄距离,确定预瞄位置的横向位移偏差,其中,预瞄位置的横向位移偏差用于表示目标车辆行驶至预瞄位置时,预瞄位置与位于目标路径上的第二横向位置之间的距离,预瞄位置在目标车辆的中轴线上的投影位置与目标位置之间的距离为预瞄距离,且从目标位置指向预瞄位置之间的矢量方向与目标车辆当前的行进方向之间的夹角小于九十度,第二横向位置为目标路径上与预瞄位置之间的距离最小的位置;根据当前的横向位移偏差、横向角度偏差、预瞄位置的横向位移偏差、滑模切换面方程以及滑模控制参数,确定滑模控制率,滑模切换面方程用于指示滑模控制方法的滑模切换面,滑模控制率用于控制目标车辆沿目标路径行驶;根据滑模控制率,控制目标车辆的行驶轨迹。可选地,在确定当前的横向位移偏差时,处理器202具体用于:根据第一公式确定当前的横向位移偏差yl,第二公式为:其中,表示对yl求导,vy为目标车辆在垂直目标车辆当前时刻的行进方向上的横向速度,yl为根据目标车辆的三维系统状态表达式确定的;在确定横向角度偏差时,处理器具体用于:根据第二公式确定横向角度偏差εl,第二公式为:其中,表示对εl求导,ρ为目标路径的曲率,vx为目标车辆在目标车辆当前时刻的行进方向上的纵向速度,β为当前时刻目标车辆当前时刻的行进方向与行进方向在水平面的投影之间的夹角,yl为根据目标车辆的三维系统状态表达式确定的,w为目标车辆的横摆角速度,w为根据目标车辆的三维系统状态表达式确定的。可选地,目标车辆的三维系统状态表达式为:其中,u为目标车辆的转向角,表示对vy求导,表示对w求导,a11、a12、a21、a22、b11以及b21均为根据当前时刻目标车辆的状态信息以及道路的路面信息确定的系数。可选地,a11为根据第三公示确定的,第三公式为:其中,cr为目标车辆的后轮胎的侧偏刚度,cf为目标车辆的前轮胎的侧偏刚度,m为目标车辆的质量,vx为目标车辆在目标车辆当前时刻的行进方向上的纵向速度,β为当前时刻目标车辆当前时刻的行进方向与水平面之间的夹角;a12为根据第四公示确定的,第四公式为:其中,a为目标车辆的前轮轴距,b为目标车辆的后轮轴距;a21为根据第五公示确定的,第五公式为:其中,j为目标车辆的转动惯量;a22为根据第六公示确定的,第六公式为:b11为根据第七公示确定的,第七公式为:b21为根据第八公示确定的,第八公式为:可选地,确定预瞄距离时,处理器202具体用于:确定第一曲率与第二曲率,其中,第一曲率为目标路径在第一横向位置的曲率、目标路径在第一预瞄点的曲率以及目标路径在第一横向位置与第一预瞄点之间的平均曲率,第二曲率为目标路径在第一横向位置的曲率、目标路径在第二预瞄点的曲率以及目标路径在第一横向位置与第二预瞄点之间的平均曲率,第一预瞄点为目标路径上与目标位置之间的距离大于设定距离值的点中,与目标位置之间的距离最小的点,从目标位置发出且指向第一预瞄点的矢量与目标车辆当前时刻的行进方向之间的夹角小于九十度,第二预瞄点为目标路径上与目标位置之间的距离大于设定距离值的点中,与目标位置之间的距离最小的点,从目标位置发出且指向第二预瞄点的矢量与目标车辆当前时刻的行进方向之间的夹角不小于九十度;根据第九公式,确定预瞄距离d,第九公式为:其中,d0为设定距离值,v为目标车辆的行驶速度,ρfront为第一曲率,ρnext为第二曲率。可选地,确定预瞄位置的横向位移偏差时,处理器202具体用于:根据第十公式,确定预瞄位置的横向位移偏差ye:其中,r为目标路径的转向半径,d为预瞄距离,yl为当前的横向位移偏差,εl为横向角度偏差。可选地,滑模切换面方程s1为:其中,ye为预瞄位置的横向位移偏差,α、βs以及(q/p)为滑模控制参数,α、βs以及(q/p)为正奇数;根据第十一公式确定滑模控制参数u,第十一公式为令s1为零后得到的,第十一公式为:其中,g(x)=1/((r+yl-dsinεl)vy),f(x)=2(r-dsinεl)(a11vy+a12w)+2d(ρvxcosβ-w)cosεl,r为目标路径的转向半径,d为预瞄距离,yl为当前的横向位移偏差,εl为横向角度偏差,vx为目标车辆在目标车辆当前时刻的行进方向上的纵向速度,vy为目标车辆在垂直目标车辆当前时刻的行进方向上的横向速度,w为目标车辆的横摆角速度,a11、a12为根据当前时刻目标车辆的状态信息以及道路的路面信息确定的系数。可选地,处理器202还用于:在控制目标车辆行驶之后,确定损失函数,损失函数用于表示目标车辆的预测行驶路径与实际行驶路径之间的实际损失;根据损失函数,确定滑模控制参数的调整值。可选地,确定损失函数时,处理器202具体用于:根据至少一个采样时刻目标车辆的预测横向位移偏差与实际横向位移偏差之间的偏差量,确定损失函数;其中,预测横向位移偏差用于表示任意采样时刻,目标车辆所处的第一预测位置与目标路径上的第三横向位置之间的距离,第三横向位置为目标路径上与第一预测位置之间的距离最小的位置;实际横向位移偏差用于表示采样时刻,目标车辆所处的实际位置与目标路径上的第四横向位置之间的距离,第四横向位置为目标路径上与实际位置之间的距离最小的位置。可选地,确定损失函数时,处理器202具体用于:根据至少一个采样时刻目标车辆的预测横向角度偏差与实际横向角度偏差之间的偏差量,确定损失函数;预测横向角度偏差用于表示任意采样时刻,目标车辆的预测行进方向与目标路径在第五横向位置的切线方向之间的角度偏差,第五横向位置为目标路径上与目标车辆所处的第二预测位置之间的距离最小的位置;实际横向角度偏差用于表示采样时刻,目标车辆的实际行进方向与目标路径在第五横向位置的切线方向之间的角度偏差,第五横向位置为目标路径上与目标车辆所处的第二预测位置之间的距离最小的位置。可选地,处理器202还用于:根据第十二公式,确定采样时刻目标车辆的卷积特征图cx,第十二公式为:cx=f(∑igx+bx);其中,i为输入阵,用于表示采样时刻目标车辆的状态信息以及目标车辆所处道路的路面信息,gx为可训练卷积核,bx为可训练偏置,gx的初始值为第一随机值,bx的初始值为第二随机值;根据卷积特征图cx,确定采样时刻目标车辆的预测横向位移偏差。可选地,处理器202还用于:根据第十二公式,确定采样时刻目标车辆的卷积特征图cx,第十二公式为:cx=f(∑igx+bx);其中,i为输入阵,用于表示采样时刻目标车辆的状态信息以及目标车辆所处道路的路面信息,gx为可训练卷积核,bx为可训练偏置,gx的初始值为第一随机值,bx的初始值为第二随机值;根据卷积特征图cx,确定采样时刻目标车辆的预测横向角度偏差。可选地,处理器202还用于:采用梯度下降法,调整gx和/或bx。可选地,调整gx时,处理器202具体用于:根据第十三公式确定灵敏度ωx,第十三公式为:ωx=wx+1(σ'(wx+1cx+bx+1)ψi-1),其中,wx+1表示卷积核中乘性偏置的取值,σ'(wx+1cx+bx+1)表示灵敏度函数,ψi-1为输入阵的上采样;灵敏度函数为:根据第十四公式确定gx的权值更新δwx,第十四公式为:δwx=-η∑(ωxψi+1),其中,η表示学习速率,ψi+1为输入阵的下采样;根据gx的权值更新δwx,调整gx的取值。可选地,滑模控制参数包括α、βs以及(q/p),α、βs以及(q/p)为正奇数,根据损失函数确定滑模控制参数的调整值时,处理器202具体用于:根据第十五公式确定滑模控制参数的调整值,第十五公式为:其中,f(q,k)表示α的权重因子、f(q,ε)表示βs的权重因子、f(q,q/p)表示(q/p)的权重因子,n表示α的可变化范围,m表示βs的可变化范围,g表示q/p的可变化范围,γa为增益系数,s,z,c1,c2分别为一大于零的常数,δα为α的调整值,δβs为βs的调整值,δ(q/p)为(q/p)的调整值。在采用对应各个功能划分各个功能模块的情况下,图7示出了上述实施例中所涉及的控制设备102的一种可能的功能性模块的结构示意图,其中,控制设备700包括:预瞄处理模块701、滑模控制模块702、神经网络学习控制器模块703、车辆控制模块704、地图匹配模块705。其中,预瞄处理模块701具体用于根据获取目标车辆101的状态信息以及目标车辆101所处道路的路面信息,以及确定当前的横向位移偏差yl、横向角度偏差εl、预瞄距离d预瞄位置的横向位移偏差ye等参数、变量;滑模控制模块702具体用于根据预瞄位置的横向位移偏差ye以及滑模控制参数构建滑模切换面方程,确定滑模控制率;神经网络学习控制器模块703用于通过深度学习方法确定目标车辆101行驶中的预测状态信息(例如确定采样时刻目标车辆101的预测横向位移偏差以及预测横向角度偏差),并确定损失函数,并根据损失函数确定滑膜控制参数的调整值,将调整后的滑膜控制参数输出至滑模控制模块702,用于滑模控制模块702更新滑模控制参数;车辆控制模块704具体用于根据滑模控制模块702输出的滑模控制率,控制目标车辆101的转向角;地图匹配模块705用于获取目标车辆101的实际位置和行驶速度等信息(例如确定采样时刻目标车辆101的实际横向位移偏差以及实际横向角度偏差),并输出至神经网络学习控制器模块703,用于神经网络学习控制器模块703确定损失函数。基于与上述方法实施例相同构思,本申请实施例还提供了一种计算机可读存储介质,其上存储有一些指令,这些指令被调用执行时,可以使得控制设备执行上述方法实施例、方法实施例的任意一种可能的设计中控制设备所涉及的功能。本申请实施例中,对可读存储介质不做限定,例如,可以是ram(random-accessmemory,随机存取存储器)、rom(read-onlymemory,只读存储器)等。基于与上述方法实施例相同构思,本申请实施例还提供了一种计算机程序产品,当所述计算机程序产品被计算机运行时,可以使得控制设备执行上述方法实施例、方法实施例的任意一种可能的设计中控制设备所涉及的功能。基于与上述方法实施例相同构思,本申请实施例还提供了一种芯片,该芯片可以与收发器耦合,用于实现上述执行上述方法实施例、方法实施例的任意一种可能的设计中控制设备所涉及的功能。本领域内的技术人员应明白,本申请实施例可提供为方法、系统、或计算机程序产品。因此,本申请可采用完全硬件实施例、完全软件实施例、或结合软件和硬件方面的实施例的形式。而且,本申请可采用在一个或多个其中包含有计算机可用程序代码的计算机可用存储介质(包括但不限于磁盘存储器、cd-rom、光学存储器等)上实施的计算机程序产品的形式。本申请是参照根据本申请实施例的方法、设备(系统)、和计算机程序产品的流程图和/或方框图来描述的。应理解可由计算机程序指令实现流程图和/或方框图中的每一流程和/或方框、以及流程图和/或方框图中的流程和/或方框的结合。可提供这些计算机程序指令到通用计算机、专用计算机、嵌入式处理机或其他可编程数据处理设备的处理器以产生一个机器,使得通过计算机或其他可编程数据处理设备的处理器执行的指令产生用于实现在流程图一个流程或多个流程和/或方框图一个方框或多个方框中指定的功能的装置。这些计算机程序指令也可存储在能引导计算机或其他可编程数据处理设备以特定方式工作的计算机可读存储器中,使得存储在该计算机可读存储器中的指令产生包括指令装置的制造品,该指令装置实现在流程图一个流程或多个流程和/或方框图一个方框或多个方框中指定的功能。这些计算机程序指令也可装载到计算机或其他可编程数据处理设备上,使得在计算机或其他可编程设备上执行一系列操作步骤以产生计算机实现的处理,从而在计算机或其他可编程设备上执行的指令提供用于实现在流程图一个流程或多个流程和/或方框图一个方框或多个方框中指定的功能的步骤。尽管已描述了本申请中一些可能的实施例,但本领域内的技术人员一旦得知了基本创造性概念,则可对这些实施例作出另外的变更和修改。所以,所附权利要求意欲解释为包括本申请实施例以及落入本申请范围的所有变更和修改。显然,本领域的技术人员可以对本申请进行各种改动和变型而不脱离本申请的精神和范围。这样,倘若本申请的这些修改和变型属于本申请权利要求及其等同技术的范围之内,则本申请也意图包含这些改动和变型在内。当前第1页12
当前第1页1 2 
网友询问留言 已有0条留言
  • 还没有人留言评论。精彩留言会获得点赞!
1