基于曲率控制的紧急避让路径跟踪研究
王健 王金波 彭欣 邱绪云 李爱娟(山东交通学院,济南 250357)
…………………………… 王健 王金波 彭欣 邱绪云 李爱娟 (
【摘要】针对紧急避让工况,提出一种基于曲率控制的路径跟踪控制方法。以车辆二自由度动力学模型为基础,设计基于曲率控制的二阶自抗扰路径跟踪控制器,采用前馈与反馈相结合的复合控制方法进行曲率跟踪控制。为了解决避让过程中侧向加速度过大或产生阶跃、曲率不连续问题,引入三次B样条曲线进行路径跟踪曲率规划,采用 CarSim/Simulink 联合仿真方法进行控制器性能验证。仿真结果表明,在对接和对开路面工况下,基于曲率控制的路径跟踪控制器能够保证车辆实际行驶路径曲率跟踪理想路径曲率,抵抗外界干扰能力强。
主题词:紧急避让 自抗扰控制器 复合控制 曲率控制 外界干扰U471.15 A 10.19620/j.cnki.1000-3703.20181442中图分类号: 文献标识码: DOI:
1 前言
作为一项主动安全技术,紧急避让技术可在遇到前方障碍物时帮助驾驶员快速无碰撞地进行避让,同时保证车辆行驶稳定性。紧急避让技术融合了传感器技术、计算机技术与现代信息技术,利用毫米波雷达、激光雷达、高速摄像机检测自车与前方障碍物之间的纵向和侧向距离、纵向速度和加速度,自动规划出避让路径,通过主动控制车辆前轮转角完成转向操作[1-2]。针对前轮主动转向路径跟踪问题,国内外学者采用
PID
控制、最优控制、鲁棒控制等方法进行路径跟踪控
PID
制器设计[3- 4]。 控制简单,但外界环境发生改变时自适应能力差;最优控制和鲁棒控制算法复杂,不利于工程应用,且控制效果很大程度上依赖于被控对象模型的精度。
Active Dis⁃
中科院韩京清教授提出的自抗扰控制(
turbance Rejection Control,ADRC)
能够观测并补偿外界干扰,保证路径跟踪的鲁棒性[5- 11]。本文以规划的理想
避让路径曲率和车辆实际行驶路径曲率作为输入,设计二阶自抗扰曲率跟踪控制器,为了加快跟踪速度,采用前馈与反馈控制相结合的复合控制方法进行曲率控制。基于曲率设计的路径跟踪控制器能够保证车辆在紧急避让工况下,抵抗由于路面附着系数变化引起的外界干扰。
2 车辆动力学模型及路径规划2.1 车辆动力学模型
2
车辆 自由度动力学方程能够较为准确地反映车辆的横向动力学特性[12]。为了使设计的控制器便于工2 1)
程应用,本文以 自由度车辆动力学模型(见图 为基础,设计路径跟踪控制器。忽略转向系统的影响,直接以前轮转角作为输入;忽略悬架的作用;忽略路面不平度和空气阻力影响。
2.2 路径规划
车辆要完成紧急避让过程,其驶过的轨迹类似双移线,避让轨迹需满足车辆动力学特性,需限制侧向加速度,保证避让完成后车身偏航角与水平方向平行,同时需要满足避障约束、曲率连续约束、转向速度约束[13-14]。
2 2如图 所示,以车辆质心为参考点,避让路径分为个阶段,两阶段为对称关系。其中: R1为车辆质心转弯半径; dy为车辆右前方与前方障碍物不发生碰撞要求的侧向位移; dx为车辆质心侧向位移到达dy时行驶的纵向位移; Ssteer为最小避让距离;为车辆质心转过的角度; θ yH为障碍物左侧宽度; yE为完成整个避让过程的侧向位移。车辆在避让过程中,侧向加速度限制在0.67μmg( μm
2为路面附着系数, g为重力加速度)以下,由图 可得[15]:
3 曲率跟踪控制器设计
车辆路径跟踪控制器由前馈控制和反馈控制组成。其中前馈控制由车辆等速行驶时稳态横摆角速度
增益得到,稳态横摆角速度增益为:
γ ö = uL 7)
δff 1+ Ku2 ( s
式中, Km æ lf lr ö
= -
; L为车辆轴距。
L2 cr cf前馈前轮转角δff为: δff =( + Wsgu2) · 8)
L ρ ( Wsg=式中, LK;ρ为车辆稳态行驶下的路径曲率。反馈控制输入为理想避让路径曲率和车辆实际行
4)
驶路径曲率,控制器输出为附加前轮转角。对式( 进行拉普拉斯变换,得到横摆角速度相对于车辆前轮转角的传递函数为:
对上述方程进行拉普拉斯反变换可得: γ̈ =- γ̇ - γ + d δ̇ + 10) δf ( a f
其中,车辆横摆角速度与路径曲率之间满足:
= 11)
γ uρ ( 10) 11)
由式( 和式( 可得: ρ̈ =- ρ̇ - +
ρ δ̇ +
d e ( au f au δf 12) = x1 ρ̇ = x2 ρ̈ = ẋ
、 、 、b0 = e、 f( x1, x2, δ̇ )= ρ令
2 au f
- ρ̇ - + δ̇ 12)
ρ d ,式( 可以转化成积分器串联型系
au f统,即标准形式:
ẋ1 = x2 ì ẋ = f( x1, x2, δ̇ )+
b0 δf 13) í (
2 f
= x1 y î
+
其中二阶自抗扰控制器和前馈 反馈控制器分别
4 5
如图 和图 所示。
图4 二阶自抗扰控制器
自抗扰控制器由跟踪微分器、非线性组合、扩张状态观测器组成。其中,跟踪微分器能够提取理想输入的一阶导数,并对输入信号进行滤波处理,扩张状态观测跟踪微分器是一个非线性动态环节,它能够快速无超调地跟踪输入信号并给出输入信号的微分,跟踪微分器离散化形式为: v1( k + 1)= v1( +· v2( k) h k) 14) ( v2( k + 1)= v2( +· fhan k) h式中, fhan可以表示为:
d0 =
ì rh ï d1 = d0h ï = v1( - γd( + hv2( ï γ( k) k) k) k) a0 = + 8r|
d2 γ( k)| 0 ï ì a0 - d0 sgn( ï | γ( k)| > d1 v2( k) + 2 k)), 15) γ( í ( = ï a í γ( k) ï v2( k) + , | γ( k)| ≤ d1 ï h î - sgn( a), | > d0 ì r a| = ï
ï fhan í ra | a| - , ≤ d0 ï ï d0 î î ρd(k)式中, 为理想曲率;和r h分别为速度因子和仿真步
v1(k) v2(k) ρd(k)
长; 和 分别跟踪 和 ρ̇ d( k) 。3.2 扩张状态观测器扩张状态观察器将模型不确定性及外界干扰看作一个整体扰动量,通过扩张的状态观测器将其观测出来,其离散表达式可以描述成: = z1( -
ì e( k) k) ρ( k) ï = fal( k), a1δ) fe e( fe1 = fal( k), a2, δ) e( ï 16) í ( z1( k + 1)= z1( + h[ z2( - β01e( k)] k) k) ï z2( k + 1)= z2( + h[ z3( - β02 + b0u( k)] k) k) fe ï z3( k + 1)= z3( + h[- β03 fe1] k) î z1(k) z2(k) z3(k)式中, 、 和 为扩张状态观测器输出。
fal(e(k),a,δ)非线性函数 可以描述为: ì | e( k)| a sgn[ k)], | e( e( k)| >
δ fal( e( k), a, δ)= 17) í e( k) ( , |
e( k)| ≤
δ δ1- a î
( h)式中, a1、a2、和δ b0为设计参数; β01= 1 和、β02 =1 2 ( β03 =2 52h1.2)为扩张状态观测器增益 。
[14]
3.3 非线性组合
非线性组合实质是一种非线性状态误差反馈控制PD
律,实际上是一个非线性 控制律,可以用离散形式描述: 4 联合仿真验证为了验证控制器的控制效果,进行不同工况下联合
CarSim
仿真验证。车辆动力学仿真软件 能够模拟真实车辆动力学特性,具有使用方便、运算迅速、仿真精度高
6 CarSim Simulink
等优点。图 所示为 和 联合仿真结构框图。6图 联合仿真框图CarSim C- Class Hatchback
利用 提供的某款 车型进1
行控制器联合仿真验证,车辆主要参数如表 所示。
表1 车辆参数4.1 对接路面工况
30 m/s
车辆以纵向速度 在对接路面进行紧急避让
CarSim
路径跟踪测试,其中 可以方便地设置路面附着
7 CarSim 3D
系数,图 所示为 建立的对接路面 图。7 3D图 对接路面 图r= 120,经不断调整,得到自抗扰控制器参数为: h= 0.001, β01= 600, β02= 1.2×105, β03= 8×106, a1= 0.5, a2= 0.5, δ= 0.5, b0= 15, β1= 1.5, β2= 2, α01= 0.25, α02= 1, δ0= 0.01 8
。图所示为车辆在对接路面的紧急避让路径跟踪结果,车辆在对接路面行驶时,基于曲率设计的跟踪控制器能够控制车辆跟踪规划的理想避让路径。图8 路径跟踪结果9 CarSim
图 所示为 给出的紧急避让过程中车辆左、右前轮转角变化曲线,整个避让过程中车辆实际行驶路径曲率能够快速、准确、无超调地跟踪规划的理想曲
10
率。图 所示为车辆实际行驶曲率跟踪理想规划曲率结果,整个避让过程中路面附着系数变化引起的外界干
11
扰量可以通过扩张状态观测器观测获得,如图 所示,自抗扰控制器能够补偿干扰量,保证路径跟踪鲁棒性。
图11 扩张状态观测器输出扰动量
自抗扰控制器需要调节参数多,参数整定困难,但一经调试完成后不需要进行二次调整,在自抗扰控制器参数不变的情况下,进行对开路面测试。
4.2 对开路面工况
30 m/s CarSim
以纵向速度 在对开路面行驶,利用
IMP_MUX_L1
提供的轮胎与路面附着系数接口 、
IMP_MUX_R1 IMP_MUX_L2 IMP_MUX_R2
、 、 可以设置
12
车辆两侧路面附着系数,路面附着系数变化如图所示。12图 路面附着系数变化13
图 所示为车辆在对开路面进行紧急避让路径跟13
踪时的跟踪结果,从图 中可以看出,车辆在对开路面行驶时,基于曲率设计的跟踪控制器能够控制车辆跟踪规划的理想避让路径。13图 路径跟踪14 CarSim
图 所示为 给出的紧急避让过程中车辆左、右前轮转角变化曲线,整个避让过程,车辆实际行驶路径曲率能够快速、准确、无超调地跟踪规划的理想曲
15
率。图 所示为车辆实际行驶曲率跟踪理想规划曲率结果,整个避让过程中路面附着系数变化引起外界干扰
16
量可以通过扩张状态观测器观测出来,如图 所示,自抗扰控制器能够补偿干扰量,保证路径跟踪鲁棒性。14图 前轮转角变化CarSim
整个紧急避让过程可以通过 后处理进行仿17),
真演示(见图 汽车能够安全无碰撞地避让前方车辆及其障碍物。
5 结论
基于曲率设计的路径跟踪控制器设计简单,能够保证车辆实际行驶轨迹曲率跟踪理想规划的曲率;基于曲率设计的自抗扰控制器能够观测并补偿外界路面附着系数引起的干扰,保证路径跟踪鲁棒性;自抗扰控制算法简单、便于工程应用,参数鲁棒性强,但是需要调整参数多,参数整定困难。
参考文献
[1] , , , . [J].徐友春 王荣本 李兵 等 世界智能车辆近况综述 汽, 2011, 23(5): 289-295.车工程[2] , , . [J].李玮 高德芝 段建民 智能车辆自由换道模型研究 公, 2010, 27(2): 119-123.路交通科技[3] , , .李一染 陈慧 高博麟 自抗扰控制在前轮主动转向控制[J]. , 2011, 33(5): 388-391.中的应用 汽车工程[4] Zhang H, Zhang X, Wang J. Robust Gain- Scheduling Energy- to- Peak Control of Vehicle Lateral Dynamics Stabilisation[J]. Vehicle System Dynamics, 2014, 52(3): 309340. [5] . PID [J]. ,韩京清 从 技术到“自抗扰控制”技术 控制工程2002, 9(3): 13-18. [6] Gao Q, Sun Z, Yang G L, et al. A Novel Active Disturbance Rejection- Based Control Strategy for a Gun Control System [J]. Journal of Mechanical Science and Technology, 2012, 26 (12): 4141-4148.
[7] Chen W H, Yang J, Guo L, et al. Disturbance- ObserverBased Control and Related Methods - An Overview[J]. IEEE Transactions on Industrial Electronics, 2016, 63(2): 10831095. [8] Li S L. Yang X, Yang D. Active Disturbance Rejection Control for High Pointing Accuracy and Rotation Speed[J]. Automatica, 2009, 45(8): 1854-1860. [9] . [J].韩京清 扩张状态观测器参数与菲波纳奇数列 控制工, 2008, 15( 2): 1-3.程 增刊[10] , , , .杨建森 李飞 丁海涛 等 基于广义预测控制的汽车横[J]. , 2012, 43(1): 1-5.摆稳定性控制 农业机械学报[11] , , .陈增强 孙明玮 杨瑞光 线性自抗扰控制器的稳定性研[J]. , 2013, 39(5): 574-580.究 自动化学报[12] , , , . [M]. :余志生 夏群生 赵六奇 等 汽车理论 北京 机械工, 2006.业出版社[13] Gόmez- Bravo F, Cuesta F, Ollero A, et al. Continuous Curvature Path Generation Based on β Spline Curves for Parking Manoeuvres[J]. Robotics and Autonomous Systems, 2008, 56(4): 360-372. [14] González D, Pérez J, Milanés V, et al. A Review of Motion Planning Techniques for Automated Vehicles[J]. IEEE Transactions on Intelligent Transportation Systems, 2016, 17(4): 1135-1145. [15] Soudbakhsh D, Eskandarian A, Chichka D. Vehicle Collision Avoidance Maneuvers with Limited Lateral Acceleration Using Optimal Trajectory Control[J]. Journal of Dynamic Systems, Measurement, and Control, 2013, 135 (4): 041006. (责任编辑 斛畔) 2019 3 18修改稿收到日期为 年 月 日。