一种四轮独立驱动无人驾驶电动车辆轨迹跟踪控制方法.pdf

(19)中华人民共和国国家知识产权局(12)发明专利申请(10)申请公布号CN108454623A(43)申请公布日2018.08.28(21)申请号201810058632.1(22)申请日2018.01.22(71)申请人大连理工大学地址116024辽宁省大连市高新园区凌工路2号(72)发明人郭烈李君臣许林娜孙大川李琳辉(74)专利代理机构大连东方专利代理有限责任公司21212代理人李洪福(51)Int.Cl.B60W30/10(2006.01)B60W50/00(2006.01)权利要求书3页说明书12页附图3页(54)发明名称一种四轮独立驱动无人驾驶电动车辆轨迹跟踪控制方法(57)摘要本发明公开了一种四轮独立驱动无人驾驶电动车辆轨迹跟踪控制工作方法，包括以下步骤：建立上层控制器，实现主动转向控制；建立中层控制器，实现车辆横摆稳定性控制；建立下层控制器，控制实际车速能稳定跟踪期望车速。本发明考虑车辆横向稳定性的四轮独立驱动无人驾驶车辆轨迹跟踪方法，通过上层控制器对期望轨迹进行跟踪，中层控制器利用上层控制器规划出的前轮转角对期望横摆角速度进行跟踪，实现了车辆在轨迹跟踪时的稳定性。本发明将车辆动力学约束加入上层控制器，能提高模型精确度和车辆行驶的安全性。上层控制器通过对车辆以及参考轨迹未来时刻的状态变化的考虑，提高了轨迹跟踪的精度。本发明算法简单有效，求解时间短、实时性好。CN108454623ACN108454623A权利要求书1/3页1.一种四轮独立驱动无人驾驶电动车辆轨迹跟踪控制工作方法，其特征在于：包括以下步骤：A、建立上层控制器，实现主动转向控制A1、根据车辆单轨模型，建立二自由度车辆动力学模型，并将其写成状态空间表达形式为：ηdyn＝hdyn(ξdyn)考虑到轮胎所受的垂直力、纵向力、侧向力和回正力矩对车辆的平顺性、操纵稳定性和安全性起着重要作用；基于小角度假设和线性轮胎公式推导出车辆动力学非线性模型，其中状态量：式中：代表车辆横向速度，代表车辆的纵向速度，代表横摆角，γ为横摆角速度，Y为车辆的横向位移，X为车辆的纵向位移；控制量选取为：udyn＝δf(2)式中:udyn代表控制量，δf为前轮转角；A2、将公式(1)-(2)所示的车辆动力学非线性模型进行线性处理，得到需要的线性时变系统为：A3、将公式(3)采用一阶差商的方法进行离散化处理，得到离散的状态空间表达式：ξdyn(k+1)＝Adyn(k)ξdyn(k)+Bdyn(k)udyn(k)(4)其中Adyn(k)＝I+TAdyn(t)，Bdyn(k)＝TBdyn(t)A4、设车辆轨迹跟踪过程某一时刻为t时刻，为求t时刻的前轮转角，建立如下目标函数：式中：Np为预测时域，Nc为控制时域，ρ为权重系数，ε为松弛因子；A5、因为在建立车辆动力学非线性模型时对轮胎模型进行了线性近似，故在求解A4所建立目标函数时，需要对轮胎侧偏角、车辆横向加速度、质心侧偏角进行约束，即ay,min-ε≤ay≤ay,max+ε，-2.5°＜αf,t＜2.5°，-2°＜β＜2°，否则会导致求解精度降低；A6、对目标函数(5)求解后得到控制时域内的一系列控制输入增量和松弛因子：将该t时刻对应的控制量的第一个元素加上上一个时刻即(t-1)时刻对应的控制量作为实际的前轮转角的控制量δf；A7、在t+1时刻，重复步骤A1-A6，完成对期望轨迹的跟踪；B、建立中层控制器，实现车辆横摆稳定性控制B1、根据当前纵向车速vxr与上层控制器计算出的车辆前轮转角δf，计算得到理想横摆2CN108454623A权利要求书2/3页角速度为：式中：γd为理想橫摆角速度，γ0为目标横摆角速度；γmax为目标横摆角速度的最大值，vxr为理想纵向速度；B2、由平面四轮车模型，在y方向上进行受力分析得到汽车绕质心的力矩方程为：式中：Iz代表汽车绕z轴的转动惯量，γ为实际的横摆角速度，Mx为橫摆控制力矩，lf为质心到前轴的距离，lr为质心到后轴的距离，Fyi为第i个车轮的横向力，车辆的左前、右前、左后、右后四个车轮分别标定为1、2、3、4号车轮，lw为轮距，Md为考虑侧向风、路面凹凸不平形成的干扰力矩；根据式(9)建立准滑膜橫摆力矩控制器，为了降低滑膜变结构的控制的高频抖动，利用双曲正切函数代替符号函数，准滑膜橫摆力矩控制器为：C、建立下层控制器，控制实际车速能稳定跟踪期望车速C1、在进行驱动力矩分配之前，需要计算总的驱动力矩；下面将期望纵向车速和实际纵向车速的差值作为PID控制的输入，电子油门开度作为PID控制的输出；然后通过查油门工作特性表得到总的驱动力矩T；C2、四个车轮的纵向力表示为：Fx＝[Fx1Fx2Fx3Fx4](11)式中：Fxi为第i个车轮的纵向力构建驱动力矩性能指标为：式中：车辆的左前、右前、左后、右后四