1.一种考虑耦合坡度的地面车辆低算力路径跟踪控制方法,其特征在于,包括以下步骤:步骤一:通过坐标变换和动力学分析建立考虑耦合坡度的车辆动力学模型和运动学模型,保证无人地面车辆在耦合坡度上的路径跟踪精度;
步骤二:构建考虑执行器时滞的无人地面车辆路径跟踪系统并进行状态空间方程离散化,用于模型预测控制;
步骤三:设计路径跟踪控制方法,利用拉盖尔函数对路径跟踪系统状态空间方程和代价函数进行改写,将传统模型预测控制中二次规划的环节转换为求导环节,降低控制方法的算力需求。
2.根据权利要求1所述的一种考虑耦合坡度的地面车辆低算力路径跟踪控制方法,其特征在于,所述步骤一的具体方法如下:S11:定义三个坐标系,分别为全局坐标系、车辆坐标系和车辆投影坐标系;其中,全局坐标系固定于平坦地面,车辆坐标系位于车辆重心,车辆投影坐标系原点为车辆重心在XOY平面上的投影;
S12:全局坐标系下车辆的重力会产生沿车辆坐标系的附加力和,如下所示:(1)
(2)
(3)
式中,为纵向附加力;为横向附加力;为垂向附加力;为车辆投影坐标系道车辆坐标系的坐标变换矩阵;为全局坐标系到车辆投影坐标系的坐标变换矩阵;为道路侧向坡度;为道路纵向坡度;为车辆投影航向角;为车辆质量;;
S13:建立忽略车辆的侧倾、俯仰和垂向运动的耦合坡度上的车辆动力学模型,如下所示:(4)
(5)
式中,为车辆横摆转矩;为车辆侧偏角;为车辆横摆角速度;为车辆纵向速度;为车辆横向速度;为四个轮胎的纵向力,为四个轮胎的侧向力,为时代表前轮,为时代表后轮,为时代表右轮,为时代表左轮;为理想前轮转向角;为车辆重心距前轴的距离;为车辆重心距后轴的距离;为车辆轮距;为横向附加力;
假定车辆转角和纵向加速度为零,则将式(4)和式(5)改写为:(6)
(7)
式中,为耦合坡度引起的车辆横摆力矩;为由于车轮转矩分配引起的附加车辆横摆力矩;为地面摩擦系数;为车辆所受右侧垂向力;为车辆所受左侧垂向力;
在耦合坡度及侧向加速度影响下,两侧轮胎垂向力计算为:(8)
(9)
式中,为道路坡度;为车辆质心距地面高度;为车辆轴距;
通过将轮胎模型线性化,前后轴轮胎所受侧向力能够表示如下:(10)
(11)
(12)
(13)
式中,为四个轮胎的侧偏刚度,为时代表前轮,为时代表后轮,为时代表右轮,为时代表左轮;为前轮的侧偏角;为后轮的侧偏角;
综合上述公式(1)-(13),建立如下考虑耦合坡度的车辆动力学模型:(14)
(15)
式中,为车辆前轴侧偏刚度;为车辆后轴侧偏刚度;
S14:在参考路径上建立Frenet坐标系;横向误差为车辆重心与参考路径重心的距离,航向误差为车辆实际航向角与处参考路径切向角的差;
路径跟踪车辆运动学模型表示为:
(16)
式中,为道路曲率。
3.根据权利要求2所述的一种考虑耦合坡度的地面车辆低算力路径跟踪控制方法,其特征在于,所述步骤二的具体方法如下:S21:结合考虑耦合坡度的车辆动力学模型和车辆运动学模型,得到考虑执行器时滞的无人地面车辆路径跟踪方程:(17)
式中,为实际前轮转向角;为表征执行器时滞特性的时间常数;
选取无人地面车辆路径跟踪系统变:选取状态变量,输入变量,扰动变量;
S22:依据无人地面车辆路径跟踪系统变量,建立考虑执行器时滞的路径跟踪系统状态空间方程:(18)
式中,为状态变量;为输入变量;为扰动变量;
;
;
;
式中,为路径跟踪系统矩阵;为路径跟踪输入矩阵;为路径跟踪状态干扰矩阵;
S23:将路径跟踪系统状态空间方程离散化;模型预测控制采用离散模型预测被控对象的未来状态,并通过滚动优化得到最优控制量;将连续时间下的系统状态空间方程进行离散化;采用零阶保持离散化方法将式(18)中的连续时间矩阵进行离散化,得到离散后的路径跟踪系统状态空间方程:(19)
(20)
式中,为第个周期的状态变量;为第个周期的输入变量;为第个周期的干扰变量;为离散路径跟踪系统矩阵;为离散路径跟踪输入矩阵;为离散路径跟踪状态干扰矩阵;为第个周期的状态变量;为离散时间。
4.根据权利要求3所述的一种考虑耦合坡度的地面车辆低算力路径跟踪控制方法,其特征在于,所述步骤三的具体方法如下:S31:构建无人地面车辆路径跟踪的多目标优化问题:(21)
(22)
式中,为代价函数;为第个周期的状态变量;为第个周期的输入量增量;为最大输入量增量;为最大输入量;为预测步长;为输出权重矩阵;为输入权重矩阵;为输入量;为第个周期的输入量增量;为第个周期的参考状态量;
S32:利用拉盖尔函数描述车辆的转向角和附加横摆力矩序列;离散拉盖尔函数的形式如下式所示:(23)
式中,为第项离散拉盖尔函数;是离散拉盖尔函数的极点;为离散拉盖尔函数的项数;为复数变量;
为简化车辆路径跟踪离散系统的分析,将进行变换使离散拉盖尔函数表达为如下的形式:(24)
式中,是的变换,为变换项数,构成了离散拉盖尔函数的多项式;为第项路径跟踪拉盖尔多项式;
同时为简化路径跟踪系统的分析,路径跟踪拉盖尔多项式递归表示为:(25)
(26)
(27)
式中,为的递推矩阵;为第项路径跟踪拉盖尔多项式;为初始路径跟踪拉盖尔多项式;
车辆在时刻的输入量利用路径跟踪拉盖尔多项式描述为:(28)
(29)
式中,为拉盖尔拟合系数;为转向角增量;和分别为转向角和附加横摆力矩的拉盖尔拟合系数;为转向角增量的Laguerre拟合系数;为附加横摆力矩的Laguerre拟合系数;为第项路径跟踪拉盖尔多项式中的第项变换离散拉盖尔函数;为第项路径跟踪拉盖尔多项式;
利用通过路径跟踪拉盖尔多项式描述的转向角和附加横摆力矩对离散状态空间方程和代价函数进行改写;将输入量带入离散状态空间方程,结合式(28)进行如下的迭代推导得到利用路径跟踪拉盖尔多项式表示的系统状态量和输出量:(30)
式中,为第个周期的路径跟踪拉盖尔多项式;
车辆路径跟踪优化问题的代价函数使用路径跟踪拉盖尔多项式进行改写:(31)
(32)
(33)
式中,为改写后的代价函数;为状态整合矩阵;为拉盖尔整合矩阵;为第项路径跟踪拉盖尔多项式;
通过对拉盖尔拟合系数求导获得路径跟踪最优输入量序列;路径跟踪控制的目标是找到合适的输入量序列,使建立的代价函数的值最小;通过转换,代价函数已经被描述成关于拉盖尔拟合系数的函数;因此,通过将代价函数对求导等于零得到对应的最优拉盖尔拟合系数:(34)
(35)
式中,为路径跟踪最优拉盖尔拟合系数;和分别为和的矩阵:(36)
(37)
通过推导计算并结合式(28)得到利用拉盖尔函数拟合后的第个周期的输入变量;每个控制周期选取其中的第一行,即为路径跟踪最优转向角增量和由于车轮转矩分配引起的附加车辆横摆力矩。