详情

原文传递一种四轮独立驱动无人驾驶电动车辆轨迹跟踪控制方法

专利名称：	一种四轮独立驱动无人驾驶电动车辆轨迹跟踪控制方法
摘要：	本发明公开了一种四轮独立驱动无人驾驶电动车辆轨迹跟踪控制工作方法，包括以下步骤：建立上层控制器，实现主动转向控制；建立中层控制器，实现车辆横摆稳定性控制；建立下层控制器，控制实际车速能稳定跟踪期望车速。本发明考虑车辆横向稳定性的四轮独立驱动无人驾驶车辆轨迹跟踪方法，通过上层控制器对期望轨迹进行跟踪，中层控制器利用上层控制器规划出的前轮转角对期望横摆角速度进行跟踪，实现了车辆在轨迹跟踪时的稳定性。本发明将车辆动力学约束加入上层控制器，能提高模型精确度和车辆行驶的安全性。上层控制器通过对车辆以及参考轨迹未来时刻的状态变化的考虑，提高了轨迹跟踪的精度。本发明算法简单有效，求解时间短、实时性好。
专利类型：	发明专利
国家地区组织代码：	辽宁;21
申请人：	大连理工大学
发明人：	郭烈;李君臣;许林娜;孙大川;李琳辉
专利状态：	有效
发布日期：	2019-01-01T00:00:00+0800
申请号：	CN201810058632.1
公开号：	CN108454623A
代理机构：	大连东方专利代理有限责任公司 21212
代理人：	李洪福
分类号：	B60W30/10(2006.01)I;B60W50/00(2006.01)I;B;B60;B60W;B60W30;B60W50;B60W30/10;B60W50/00
申请人地址：	116024 辽宁省大连市高新园区凌工路2号
主权项：	1.一种四轮独立驱动无人驾驶电动车辆轨迹跟踪控制工作方法，其特征在于：包括以下步骤：A、建立上层控制器，实现主动转向控制A1、根据车辆单轨模型，建立二自由度车辆动力学模型，并将其写成状态空间表达形式为：η_dyn＝h_dyn(ξ_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，计算得到理想横摆角速度为：式中：γd为理想橫摆角速度，γ0为目标横摆角速度；γ_max为目标横摆角速度的最大值，v_xr为理想纵向速度；B2、由平面四轮车模型，在y方向上进行受力分析得到汽车绕质心的力矩方程为：式中：Iz代表汽车绕z轴的转动惯量，γ为实际的横摆角速度，Mx为橫摆控制力矩，lf为质心到前轴的距离，lr为质心到后轴的距离，Fyi为第i个车轮的横向力，车辆的左前、右前、左后、右后四个车轮分别标定为1、2、3、4号车轮，lw为轮距，Md为考虑侧向风、路面凹凸不平形成的干扰力矩；根据式(9)建立准滑膜橫摆力矩控制器，为了降低滑膜变结构的控制的高频抖动，利用双曲正切函数代替符号函数，准滑膜橫摆力矩控制器为：C、建立下层控制器，控制实际车速能稳定跟踪期望车速C1、在进行驱动力矩分配之前，需要计算总的驱动力矩；下面将期望纵向车速和实际纵向车速的差值作为PID控制的输入，电子油门开度作为PID控制的输出；然后通过查油门工作特性表得到总的驱动力矩T；C2、四个车轮的纵向力表示为：Fx＝[Fx1 Fx2 Fx3 Fx4] (11)式中：Fxi为第i个车轮的纵向力构建驱动力矩性能指标为：式中：车辆的左前、右前、左后、右后四个车轮分别标定为1、2、3、4号车轮；σi＝μiFzi，i＝1,...,4μi为i号车轮的路面附着系数；Fzi为第i号车轮所受的垂直载荷；WT为加权矩阵：C3、在步骤C2基础上建立如下优化函数，求解驱动力矩；s.t. SFx＝FT (15)C4、针对步骤C3建立的优化函数，利用伪逆法进行求解：分配到四个车轮的力矩为：式中：u1,u2分别代表左侧、右侧车轮总的驱动力矩；这里将左右两侧驱动力矩平均分配，即u1＝0.5T，u2＝0.5T；C5、将中层控制器计算得到的橫摆控制力矩分配到四个车轮；分配规则如下：即车辆前后轴各产生所需附加橫摆力矩的1/2；车辆四个车轮最终的驱动力矩由步骤C4计算出的驱动力矩加上每个车轮应分配的橫摆控制力矩，最终车轮驱动力矩为：
所属类别：	发明专利