1.一种车辆轨迹跟踪方法,其特征在于,包括以下步骤:
步骤1,获取车辆当前位置坐标、当前时刻的航向角、当前时刻的质心侧偏角、当前时刻的速度、当前时刻的横摆角速度,并根据目标轨迹路径获取跟踪路径轨迹点坐标和每个轨迹点的航向角;
步骤2,基于车辆当前位置坐标、当前时刻的航向角及根据目标轨迹路径获取的跟踪路径轨迹点坐标和每个轨迹点的航向角,计算前轮中心的横向偏差与航向偏差,并通过Stanley控制算法计算出车辆前轮转角,其中,对于Stanley控制算法中的增益参数,以增益参数的差值平方和最小作为搜索求解的目标函数,通过粒子群算法对增益参数进行优化调整;
步骤3,基于当前时刻的航向角、每个轨迹点的航向角、当前时刻的速度、当前时刻的横摆角速度,建立基于消除航向角偏差的线性二次型调节器控制算法,计算由航向偏差引起的前轮转角;
步骤4:基于步骤2得到的车辆前轮转角和步骤3得到的由航向偏差引起的前轮转角,针对车辆变道场景,建立基于权重占比的控制策略,该控制策略以航向角为判别依据,根据不同车速与变道所处阶段的不同行驶需求,实时调整权重占比,得到最优前轮转角;
步骤5:基于最优前轮转角获取车辆当前时刻的方向盘转角,对车辆进行横向控制,同时基于当前时刻的速度,采用PID控制器对车辆进行纵向控制,从而对车辆进行轨迹跟踪;
步骤2中,车辆前轮转角的表达式为:
其中, 表示车辆前轮转角, 为航向偏差,e(t)为横向偏差,k为增益参数,v(t)为当前时刻的速度;
以增益参数的差值平方和最小作为搜索求解的目标函数的步骤中,满足以下条件式:其中,ke为目标增益参数, 为期望转角, 为期望质心侧偏角,l为车辆轴距,F为稳定性因数,a为车辆质心到车辆前轴的距离,b为车辆质心到车辆后轴的距离,m为车辆的整车质量,Cf、Cr分别为车辆前后轮侧偏刚度;
通过粒子群算法对增益参数进行优化调整的步骤中,满足以下条件式:其中,h为参数信息的实际方差, 为优化参数差值序列,T表示转置操作,为优化参数真实值,Wi为权重系数,n为迭代次数,N为大于0的自然数, 为实际参数差值序列;
步骤3具体包括:
步骤301,建立基于跟踪误差的动力学模型;
步骤302,通过动力学模型推导得到基于航向偏差的状态空间方程;
步骤303,通过基于航向偏差的状态空间方程设定控制性能目标函数;
步骤304,基于控制性能目标函数提高加权矩阵中航向偏差的权重占比,得到由航向偏差引起的前轮转角;
由航向偏差引起的前轮转角通过下式计算得到:
其中,J表示控制性能目标函数,t表示t时刻, 为状态变量, 表示由航向偏差引起的前轮转角,Q、R为加权矩阵,T表示转置操作;
所述步骤301中,基于跟踪误差的动力学模型中,在特定车速的条件下,由车辆在侧向和横摆两个方向进行受力分析,得到下示方程:其中,m为车辆的整车质量,ay为汽车侧向加速度,Ff、Fr为前、后轴侧向力,Iz为绕z轴转动量,为横摆角速度,a为车辆质心到车辆前轴的距离,b为车辆质心到车辆后轴的距离;
根据航向偏差、横向偏差与车速进行推导,能够得到基于跟踪误差的动力学方程;
进而,由航向偏差引起的前轮转角通过下式计算得到:
其中,J表示控制性能目标函数,t表示t时刻, 为状态变量, 表示由航向偏差引起的前轮转角,Q、R为加权矩阵,T表示转置操作;
通过上式的极小值可得到前轮转角控制规律如下式所示:
其中,K、B1、P、A均为中间向量,P满足Riccati方程,T表示转置操作;
步骤4中,最优前轮转角的表达式为:
其中, 表示最优前轮转角,ma表示最优前轮转角的权重因子,mb表示由航向偏差引起的前轮转角的权重因子,且ma+mb=1。