欢迎来到知嘟嘟! 联系电话:13336804447 卖家免费入驻,海量在线求购! 卖家免费入驻,海量在线求购!
知嘟嘟
我要发布
联系电话:13336804447
知嘟嘟经纪人
收藏
专利号: 2022116513327
申请人: 华东交通大学
专利类型:发明专利
专利状态:已下证
专利领域: 控制;调节
更新日期:2026-11-16
缴费截止日期: 暂无
价格&联系人
年费信息
委托购买

摘要:

权利要求书:

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。