1.一种智能电动汽车轨迹跟踪与运动控制方法,其特征在于,包括以下步骤:步骤1、根据给定目标轨迹以及当前路况,判断车辆是否能够工作在侧向稳定范围内;
若工作在稳定区域内,执行步骤2;若超出侧向稳定范围,执行步骤3;
步骤2、执行工作模式1,采用车辆轨迹跟踪与横摆稳定双闭环控制进行车辆轨迹跟踪与稳定性控制:根据期望行驶轨迹以及车辆运动学模型,解算出车辆的期望航向角;建立三自由度车辆动力学模型,设计轨迹跟踪控制器,将车辆的期望航向角与上一时刻的航向角差值输入到轨迹跟踪控制器,求解得到前轮转角和纵向速度;采用模型预测控制算法设计横摆稳定控制器,并将轨迹跟踪控制器求解得到的前轮转角与纵向速度作为横摆稳定控制器的状态输入,再进行力矩分配,实现对智能车的控制;
步骤3、执行工作模式2,进行对车辆轨迹跟踪的漂移控制:计算在漂移状态下车辆质心位置变化,建立用于对车辆轨迹进行跟踪的漂移控制车辆动力学模型,并设计轨迹跟踪控制器进行漂移控制。
2.如权利要求1所述的一种智能电动汽车轨迹跟踪与运动控制方法,其特征在于,所述步骤2中,建立上自由度车辆动力学模型包括以下步骤:建立三自由度车辆动力学方程:
式中:vx、vy分别表示车辆的纵向速度和侧向速度;Flf、Flr分别表示为车辆前、后轮与轮胎的纵向刚度、滑移率有关的纵向力;Fcf、Fcr分别表示为车辆前、后轮与轮胎的侧偏刚度、侧偏角有关的侧向力;γ为车辆横摆角速度;a、b分别为车辆质心到前、后轴的距离;δf为前轮转角;Iz为转动惯量;
轮胎力表示为:
Flf=Clfsf
Flr=Clrsr
式中:Clf、Clr分别表示为车辆前、后轮胎的纵向刚度;Ccf、Ccr分别表示为车辆前、后轮胎的侧向刚度;sf、sr分别表示为车辆前、后轮胎的纵向滑移率。
3.如权利要求1所述的一种智能电动汽车轨迹跟踪与运动控制方法,其特征在于,所述步骤2中,设计轨迹跟踪控制器并获得包括以下步骤:面向轨迹跟踪控制器设计的控制模型为:
状态变量为 u=[δf]为控制量,控制输出为离散化后的状态空间模型描述为:
定义预测时域为p,控制时域为m,p>m;
在k+p时刻,车辆状态为x(k+p)=F(x(k),u(k),u(k+1),…,u(k+m),…,u(k+p-1));
当采样时间大于控制时域时,保持控制输入不变直到预测时域u(k+m-1)=u(k+m)=u(k+m+1)=…u(k+p-1);
因此定义k时刻的最优控制输入:
相应的k时刻的预测输出:
系统的参考输入序列为:
在第k个采样时刻,y(k)作为控制系统预测的初始值,即y(k|k)=y(k);
目标函数为:
J=ΓQ||Y(k+1|k)-R(k+1)||2+ΓR||U(k)||2其中,ΓQ=diag(τQ1,τQ2,…,τQp)为控制车辆姿态的权重系数;ΓR=diag(τR1,τR2,…,τRp)为控制输入的权重系数。
4.如权利要求1所述的一种智能电动汽车轨迹跟踪与运动控制方法,其特征在于,所述步骤2中,采用模型预测控制算法设计横摆稳定控制器包括以下步骤:
1)搭建二自由度车辆动力学模型:
其中,β是质心侧偏角;γ是车身的横摆率;Fyf,Fyr分别代表二自由度车辆模型前轮侧向力和后轮侧向力;m代表整车质量;V代表纵向车速;Lf,Lr分别代表车辆质心到前轴的距离和质心到后轴的距离;Mz是车辆横摆力矩;FZ代表轮胎的垂向力负载;IZ为转动惯量;
2)基于二自由度车辆动力学模型对横摆稳定控制器进行设计。
5.如权利要求4所述的一种智能电动汽车轨迹跟踪与运动控制方法,其特征在于,所述步骤2)基于二自由度车辆动力学模型对横摆稳定控制器进行设计包括以下过程:将二自由度车辆动力学模型进行整理,得到系统的状态空间模型:将横摆角速度γ、质心侧偏角β作为系统的状态变量x=[β,γ]T,控制量为u=[δf,Tfl,Tfr,Trl,Trr]T分别为前轮转向角、四个车轮驱动电机的转矩命令,系统输出y=[β,γ]T;
利用欧拉公式进行离散化,得到的离散时间系统模型为:x(k+1)=f(x(k),u(k))·Ts+x(k),y(k)=C·x(k),
其中,k表示采样时刻,Ts为采样时间,矩阵
推导出p步预测状态和预测输出:
y(k+1|k)=C·x(k)。
6.如权利要求5所述的一种智能电动汽车轨迹跟踪与运动控制方法,其特征在于,所述横摆稳定控制器的优化目标包括:(a)主要的优化目标为:
式中,Q1,Q2是优化目标中的加权系数;
(b)电机转矩越大意味着从电池处消耗的能量就越大,减小消耗能量,控制量的平方和尽量小:式中,R1,R2是优化目标中的加权系数;
(c)为了减小控制动作的变化,保持平滑的转向和电机驱动行为,减小控制量的变化:式中,S1,S2是优化目标中的加权系数;
(d)电机饱和约束:
-Temax≤Ti(k+j|k)≤Temax,i=fl,fr,rl,rr,j=1,2,...,m-1。
7.如权利要求1所述的一种智能电动汽车轨迹跟踪与运动控制方法,其特征在于,所述步骤3执行工作模式2包括以下步骤:
3.1)数据训练:通过驾驶模拟器与车辆动力学仿真软件结合的测试平台进行漂移操作,并记录车辆状态参数和轮胎系数,构建训练数据集;
3.2)通过车辆状态参数和轮胎系数计算在漂移状态下车辆质心位置变化,建立用于对车辆轨迹进行跟踪的漂移控制车辆动力学模型,并设计基于模型预测控制的轨迹跟踪控制器,将车辆的期望航向角与上一时刻的航向角差值输入到轨迹跟踪控制器,求解得到前轮转角和纵向速度。