1.一种兼顾横向误差和航向误差收敛的自动驾驶控制方法,其特征在于,包括以下步骤:
1)轨迹预瞄器计算轨迹跟踪误差;
2)误差融合器将轨迹跟踪误差融合为综合跟踪误差;
3)根据综合跟踪误差,设计微分误差系统模型;
4)由微分误差系统模型,设计线性估计器,估计出系统状态;
5)线性延迟器计算期望的系统状态;
6)根据估计的系统状态和期望的系统状态,计算系统误差;
7)根据系统误差,线性反馈控制器计算期望控制量;
8)结合估计的系统状态计算扩张状态控制量;
9)将期望控制量和扩张状态控制量融合,得到最终的系统控制量;
所述步骤1)中,轨迹预瞄器设计为其中,ye为车辆横向误差,vd为参考轨迹上被跟踪点的期望车速,为车辆航向误差,ls为预瞄点到车辆质心的距离,L为轴距,δ为车辆前轮转角,ye参数上的圆点为所述参数的一阶微分;
所述车辆航向误差的计算方法为其中,θ为参考轨迹上被跟踪点的航向,为参考车辆的实际航向;
所述步骤2)中,误差融合器设计为其中,z为综合跟踪误差,tanh(.)为双曲正切函数,系统参数c0>0,c1>0,c2>0;
所述步骤3)中,由误差融合器模型设计的微分误差系统模型为其中,为微分误差系统模型中的不确定部分,系数b0=-c2vd/L,u为最终的系统控制量,z参数上的圆点为z的一阶微分,f(.)函数上的圆点为f(.)函数的一阶微分,v为车辆实际速度,w为系统扰动;
所述步骤4)中,设计的线性估计器的状态空间模型如公式(1)所示,其中,状态z1为z的估计值,状态z2为微分误差系统模型中的不确定部分,η为线性估计器的输出,z1参数上的圆点为z1的一阶微分,z2参数上的圆点为z2的一阶微分;
所述步骤4)中,设计的线性估计器离散后如公式(2)所示,其中,k为离散的时刻,T1为线性估计器的周期,wo>0为线性估计器的增益,ez(k)为第k时刻,线性估计器离散后的误差;z1(k)为第k时刻,参数z1的值;z(k)为第k时刻,参数z的值;z1(k+1)为第k+1时刻,参数z1的值;z2(k)为第k时刻,参数z2的值;u(k)为第k时刻,最终系统控制量u的值;z2(k+1)为第k+1时刻,参数z2的值;
所述步骤5)中,设计的线性延迟器为一阶;
所述线性延迟器的参考输入r恒为0,其输出v1也恒为0;
所述步骤6)中,系统误差计算方法为e1=v1–z1;
所述步骤7)中,线性反馈控制器设计为比例控制器;
比例控制器增益为wc/b0,线性反馈控制器输出u0的计算方法为u0=-wcz1/b0,参数wc>0为线性估计器的增益系数;
所述步骤8)中,扩张状态控制量计算方法为u1=z2/b0;
所述步骤9)中,最终的系统控制量计算方法为u=u0+u1。