对车辆建立数字化模型,分为车辆运动学和动力学模型。
车辆运动学模型(Kinematic Model )把车辆完全视为刚体,主要考虑车辆的位姿(位置坐标、航向角)、速度、前轮转角等的关系,不考虑任何力的影响。
1.前提假设:
例如如下图片:如下的公式推导都基于此图
2.车辆运动学模型推导
针对上图,我们分别求出对应的x速度,y速度,和航向角速度,这样对于状态量
对上述在任意一个参考点r进行泰勒级数展开:
再求其中两个偏导:
所以状态量误差的变化量为:
在对上面公式进行前向欧拉离散化:
最后得到:
所以这样,我们就得到了关于前一状态量误差与控制量误差和后一个状态误差量的关系。
即通过当前状态的状态量误差和控制量误差可以预测下一状态量误差。
车辆动力学模型((Dynamic Model )则需要考虑车辆和地面之间的力的影响,包括轮胎侧偏现象等。
车辆动力学模型根据自由度可以划分为:
根据受力方向又分为横向动力学和纵向动力学,一般两者解耦之后研究:
纵向上,通过控制轮胎转速实现速度跟踪;
模向上,通过控制前轮转角实现路径跟踪。
综上,在转向小角度及轮胎动力学的基础上,研究车辆线性二自由度动力学模型。
示图如下:
动力学方程推导如下:
根据系统状态方程之后就可以分析出在给定的前轮转角输入下,车辆的横向位移、横向速度、横摆角以及横摆角速度的响应,但是横向跟踪控制的目的是为了减小跟踪偏差,需要的状态方程是能够分析在给定的前轮转角下车辆跟踪偏差的响应。