维普资讯 http://www.cqvip.com 2007年(第29卷)第8期 汽车工程 Automotive Engineering 2007(Vo1.29)No.8 2007160 车辆转向与驱动综合控制及横向速度观测器的设计术 李以农 ,卢少波 ,杨柳 (1.重庆大学机械传动国家重点实验室,重庆400044;2.广州本田汽车有限公司,广州510800) [摘要] 为了实现复杂工况下车辆自动跟踪控制,建立了纵横向耦合车辆模型,研究了车辆在弯道变速行驶 工况的动力学耦合控制问题,根据滑模控制以及动态表面控制理论,提出了一种基于车辆转向与驱动控制的综合控 制器,并针对横向车速不可测,设计了横向速度观测器。仿真结果表明该综合控制器具有良好跟踪性能,在复杂工 况下表现出较好的动、静态特性。 关键词:车辆转向与驱动综合控制;横向速度观测器;滑模控制;动态表面控制 Integrated Vehicle Steering and Driving Control and the Design of Transverse Speed Observer Li Yinong .Lu Shaobo &Yang Liu 1.Chongqing University,StateKeyLaboratory ofMechanical Transmission,Chongqing 400044; 2.Guangzhou Honda Automobile Co.Ltd,Guangzhou 510800 [Abstract] A longitudinal and transverse coupled vehicle model is established to study the vehicle dynamic coupled control under a driving condition of acceleration/deceleration on curved path.Base on the theories of sliding mode control and dynamic surface control,a vehicle steering and driving integrated controller is proposed,and in view of hatt the transverse speed can not be measured,a transverse speed observer is designed.A simulation is con— ducted and the results show that the integrated controller has good tracking performance and exhibits good dynamic and static characteristics under complicated driving conditions. Keywords:Vehicle steering and driving in.grand control;Transverse speed observer;Sliding mode control;Dynamic surface control 型和制动器模型与控制器算法相结合就构成了纵向 前言 近年车辆自动驾驶一直是研究的热点 J。作 控制模式。当实现了纵向和横向自动控制,就可以 按给定目标和约束自动控制车辆运行,所以自动驾 驶控制就是对车辆的转向与驱动/制动的综合控制。 目前在对车辆自动驾驶控制的研究中,大多是 为车辆自动驾驶核心内容的汽车纵向和横向控制也 越来越引起研究人员的重视。横向控制是指控制车 辆在不同的车速、载荷、路况以及风阻等条件下自动 将纵向控制与横向控制设计为两个的互不联系 的控制器,而忽略了其相互耦合的影响。实际行驶 的车辆系统是一复杂的非线性、变参数耦合系统,存 在着严重的不确定性,特别是系统参数在不同车速 跟踪行车路线并保持一定的舒适性和平稳性,实际 上也就是车辆转向控制 J。纵向控制是指在行车 方向上的控制,即车速以及本车与前后车或障碍物 距离的控制,这类问题可以归结为对发动机和制动 器的控制[6-7]。发动机驱动力模型、车辆动力学模 下其值是不确定的,并且运动载体对控制的实时性 要求较高,纵向和横向存在很强的耦合关系。尤其 是在弯道变速行驶时,横向控制时要考虑纵向参数, 国家自然科学基金项目(50475064)和重庆市自然科学基金项目(CSTC,2006BA6017)资助。 修改稿收到日期为2007年6月27日。 维普资讯 http://www.cqvip.com 2007(Vo1.29)No.8 李以农,等:车辆转向与驱动综合控制及横向速度观测器的设计 ・693・ 纵向控制时要考虑横向参数,所以单独研究纵向、横 向控制将导致控制器误差偏大,影响控制精度,从而 影响车辆行驶的安全性。 车辆纵、横向动力学耦合主要表现在3个方面: (1)动力学耦合,即转向轮转向时,所受的横向力在 纵向上的分力对纵向速度的影响,以及车辆转弯时, m( +2J )=(F l+Fy2)cos8+ (F l+ ’ )sin8+Fy3+F 一CyU: =(2) zf(F l+F )cos8+ (F l+F娩)sin8一 Z (Fy3+F )+(d/2)(F l—F娩)cos8+ (d/2)(F l—F )sin8+(d/2)( 3一 ’ ) (3) 纵向速度对离心力大小以及横向偏移率的影响; (2)轮胎力耦合,即侧向力与纵向牵引力的相互影 响;(3)垂直载荷转移耦合,即纵向加速度的改变使 式中m为整车质量; 为车辆绕z轴的转动惯量; 为车辆纵向速度; 为横向速度; 为横摆角速度; 轮胎正压力重新分布,进而影响到横向动态特性。 针对上述问题,作者首先建立车辆的纵横向耦合动 力学模型,考虑主要的动力学耦合因素,提出了一种 基于滑模和动态表面控制的车辆转向与驱动综合控 制器,并针对横向车速不可测问题,设计了横向速度 观测器,并对观测器及综合控制器效果进行了计算 机仿真对比分析。 1 车辆动力学模型建立 1.1整车系统模型 文献[8]、文献[9]考虑车辆运动学关系和动力 学特性分别建立了l2和l8自由度的整车模型,由 于模型复杂,使其所要求的参数剧增,如文献[9]中 的模型,需要输人的参数多达149个,其中相当多的 参数较难获得,给仿真带来一些困难。作者着重研 究车辆纵、横向运动的综合控制,考虑耦合因素对控 制精度的影响,仅考虑车辆纵向、横向和横摆运动这 3个自由度,忽略车辆悬架系统的作用,简化了转向 系统,直接以前轮转角作为输人,并假设车辆左右两 侧动力学对称,得到车辆坐标系及整车模型,如图1 所示。 图1车辆坐标系和整车模型 根据车辆运动过程中的受力和运动状态,车辆 对其坐标系的运动微分方程可以描述为 m( 一2) )=(F 1+F )cos8一 (Fy1+F )sin8+F + 一CxU:一Fmll (1) F ll为滚动阻力,F l=mgfo(1+v ̄/19 440) m]; fo=0.014;c 为纵向风阻系数;C 为横向风阻系数; F i(i=1~4)为各轮胎纵向力, ( 1~4)为各轮 胎侧偏力,z 为前轴与车辆质心的距离,z 为后轴与 车辆质心的距离,d为车轮轮距,6为前轮转角。 根据假设,车辆左右两侧动力学对称,因此左右 两侧轮胎力相等。故有, = = = F =Fy3=Fy4 : 这里仅考虑小转角工况,= = 则sin8=8,cos8=1,且 F 为二阶微小项,故式(1)~式(3)可化简为 =(2F f一2F +2F 一 CxU:一F r0l1)/m+2J (5) =(2 +2Fr 一Cy 2J;)/m一2J (6) =(2lfF 一2z F ) (7) 1.2传动系统模型 动力传动系统主要由液力变矩器、变速器和主 减速器组成,图2为传动系统示意图。 … 。 图2动力传动系统示意图 假设液力变矩器锁止,即相当于液力耦合器工 况。液力变矩器涡轮的输人转矩 呷和转速 经过传动系统传递到半轴,得到半轴转矩 和车 轮转速 为 f n rgroLump (8) L∞ =tOpump/rg 0 式中rg为变速器传动比,r0为主减速器传动比。液 维普资讯 http://www.cqvip.com ・ 694・ 汽车工程 2007年(第29卷)第8期 力变矩器锁止时,其转速与发动机转速相等,即 ∞ =∞。。假设各车轮转动惯量,w相等,车轮半径 r 相等,则车轮的转动运动方程为 态,自动地实现加、减速以保证两车距在安全范围 内。为实现车辆纵向的自动跟踪,采用固定车间相 对距离和车间相对速度控制策略如下[ 。 I.io =÷[ 血一 一2r ( + )] (9) f{ — 一 一H (‘15)) 【杏= 一 式中 为车轮制动力矩。 式中6-,杏分别为被控车与前导车的纵向距离误差和 发动机的转速方程可用非线性函数描述为 误差变化率; 、 分别为被控车与前导车尾部纵向 io。=1/Ie。( 一 ) (1O) 位置坐标; 、 分别为被控车和前导车纵向速度;L 式中 、 分别为发动机转动惯量和输出转矩。 为车身长度;日为期望纵向车距。 令r。= /'0,由式(8)一式(1O)得 横向控制的目的是使车辆自动地按照预定的轨 ∞w 而: f【 一 一2 一 (一/"w( +Fx +r )]J 迹行驶在道路的中间。采用基于预瞄的横向控制策 略[】引,选取车辆预瞄点处的横向位置误差Y。及其变 (11) 化率Y’ 为控制目标: 令 =Te—Tb/r。,,。=4,w+lorz.,则式(11)可 Y =Y +Z (16) 简化为 、 当 较小时,Y = + ,对式(16)求导,得 = [r。 。 一2r (F + )] (12) Y’ = y+ h+z。 h (17) 式中Y 为车辆相对道路中心的横向位置误差;z 为 1.3轮胎模型 预瞄距离; 为车辆相对路面的方向偏差; 为被 汽车在弯道变速行驶是一种比较复杂的工况, 控车侧向速度。 存在转向、制动、驱动以及制动转向和驱动转向,车 结合整车系统模型和轮胎模型,采用带边界层 轮的纵向滑移和侧偏总是同时发生,因此简单的模 的滑模控制方法,可得到跟踪控制期望的总纵向驱 型无法描述轮胎在联合工况下的特性。Pacejka的 动力F 和控制器第1控制量即前轮期望转角 。 魔术公式是一种半经验模型,可以用于汽车运动中 而总纵向力来自发动机输出转矩 ,利用纵向驱动 包含纵向力和横向力的复杂工况,其联合工况下的 力和车轮滑移率之间的函数关系,采用基于滑移率 纵向力和横向力由下式确定[】川: 的动态表面控制方法可求取控制器第2控制量即期 { F,--=-( roJro) F ̄o (13) 望纵向驱动力矩 。控制器根据整车状态适时输 出的前轮转角 和纵向驱动力 。 使车间距 趋近 式中or= ̄/ :+ :为综合滑移率,且or =一A/(1+ 于期望值日,车间相对速度杏趋近于0,同时使得车 A),or =一tana/(1+A); 、F们分别为纯纵滑下的 辆预瞄点处的横向位置误差Y。及其变化率夕 也趋 纵向力和纯侧偏下的横向力,由Pacejka模型(不考 于0,从而实现纵横向跟踪控制。由式(5)、式(6)、 虑轮胎力水平方向和垂直方向漂移)有 式(17)可知纵向加速度是横向速度的函数,同时横 Fi0(Af)=D‘sin{Cfarctan[BiA — 向加速度、横向位置误差是纵向速度的函数,体现控 E (B A —arctan(B Ai))]} (14) 制模型中纵横向的相互耦合关系。 式中 = ,,,;当 = 时, 表示车轮滑移率A;当 Y时,A 表示轮胎侧偏角Ot;c 为Pacejka轮胎模型 3横向速度观测器的设计 常数;B 、 、 均为与车轮垂直载荷 相关的轮胎 模型参数¨ 。 由于实际情况中,车辆横向速度不可测量,必须 对横向速度进行估计,也就是设计横向速度观测器。 2转向与驱动综合控制策略 结合车辆动力学模型和预瞄运动学模型,以车辆前、 后保险杠的横向位置误差Ysf-Y。 以及横向速度 作 车辆系统的控制输入为综合控制器输出的发动 为状态变量来设计横向速度观测器。由式(16)、式 机驱动力矩 和前轮转角 。 (17)可得 纵向控制的目的是使车辆根据前导车的运动状 Y’ = + ( 一 d)+z ( 一 d) (18) 维普资讯 http://www.cqvip.com 2007(Vo1.29)No.8 Y’。 李以农,等:车辆转向与驱动综合控制及横向速度观测器的设计 ・695・ = + ( 一 d)一z。 ( 一 d) =口 一 (19) (20) 又 式中 为车辆横摆角, 为期望横摆角,0 为车辆 合输入的期望值。在过滤过程中,将综合输入期望 轨迹的微分作为过滤器输出的微分。DSC控制相对 墨—.一 。。........O ..=.. .....L 一 于PD控制、LQ最优控制、模糊控制具有结构简单、 鲁棒性和抗干扰能力强的特点,非常适合汽车的非 线性控制。 4.2基于滑移率的动态表面控制 。 采用限定滑移率的方法,根据动态表面控制理 论来求取第2控制量 。 而在实际控制过程中, 的横向加速度。假设状态变量Ysf Y 观测值 、 、v y近似表示为 可以由其 = + ( 一 d)+z日f( 一 d)+K1(Y日f—Y sf) (21) = + ( 一 d)一z。 ( 一 d)+ (Y。 一Y s ) (22) 它作为控制器输出的期望控制量,使滑移率保持在 期望值附近。求取控制量 步骤如下。 对滑移率A: 入得 =0 一 + [(Y 一 )一(Y 一 )](23) 求导,并将式(12)代 以上即表示状态观测器, (Y 一 )、 (Y 一 )、 [(Y 一 )一(Y。 一 )]为修正项,其中 ~ A一丁:一—/' VxO.)ww_+ -,r:E ,。・ 一2, 2 ( ( ’F + + )] ’ (27) 为观测器的增益。由式(18)一式(21),式 =,,。 一 ,E = 一 ,则观测器的误差方程 由式(27)可知:可通过限定A来求取 。 根据动 态表面控制的定义n ,设Adfih满足 Ad= A dmt+A dfilt (28) (19)一式(22),式(20)一式(23),且令E =Y 一 , 。 用矩阵的形式表示为 为获得精确的滑移率控制,定义动态表面为 S=Ad—A瓶l (29) 为使控制表面趋于0,采用等速趋近率 对其求解,并展开整理得 ,,~ S=一r/S 卵>0。 (30) 丑f = I L Jto 广r 式中A 为期望滑移率; 、叩均为控制器设计参数, 由式(28)~式(30)得 d=+ ( 一 d)+1日f( 一 d)]d 一 e-Klt[,,。r( )一 ( )]dt—et[vy( )一 ( )]dtJto Jto - (24) r f 一叩)(Ad—A dCa,) Ad (31) (32) I。[ + ( 一 a)+zsr( 一 ) 一 Jto 对式(28)进行拉氏变换得 e-K2t[,,。 ( )一Y sr( )]dt—et[vy( )一 ( )]dtJto A姗=÷(25) V y=将式(32)代入(31)得 【(。 )d 一-K3t[",, ( )一 ( )]d 一 (26) (÷一叩)‘ Aa 式(33)代入式(27)即得控制量 (33) + 】 (34) e [,, ( )一 ( ) = 4控制器的设计 4.1动态表面控制 + 叩) 其中F =2( + )为车轮总期望纵向力,由滑 模控制得到。 由于篇幅,仅介绍基于滑移率的动态表面 控制方法求取控制量纵向驱动力矩。动态表面控制 5仿真计算与分析 为检验控制器在纵横向复合工况时的控制效 是反演设计的进一步发展 玎 ,其本质为:将综合输 入先通过一线性过滤器,再将过滤器的输出作为综 维普资讯 http://www.cqvip.com 汽车工程 2007年(第29卷)第8期 果,设计前导车加速度信号和前方道路曲率信息如 图3所示。结合3自由度非线性车辆模型,考虑系 统纵横向动力学耦合、轮胎力耦合及垂直载荷转移 引起的耦合效应,利用滑模控制及动态表面控制理 论在Matlab/Simulink环境下进行了上述控制策略 的车辆耦合控制与非耦合情况的对比模拟试验。仿 真初始条件为 =36m/s, =0, =110.4rad/s, 时在另一弯道因纵向速度的增加,前轮转角也增大。 图5(a)为车辆前后保险杠横向位置误差的仿 真结果与观测器的结果对比。可见,前后保险杠的 横向位置误差的估计值滞后于其仿真值,但这样的 误差是允许的。从图5(b)可以看出,车辆横向速度 的观测值与仿真结果非常接近,观测器效果较好;图 6为车辆在转向与驱动综合控制器作用下跟踪前导 r=0.1,叼:2,K1=1.732, =1.414, =0.005。 量 餐 景 曲 娶 * 淀 鑫 时间/s 时间/s (a)前导车加速度 (b)前方道路曲率信息 图3前导车加速度及道路信息 图3所示复合工况主要包含了两个弯道变加速 运动。开始车辆匀速驶入半径为200m的弯道,然 后先作变加速运动再作匀加速运动同时驶出弯道。 在直道上先作变加速运动然后匀速运动并驶入另一 半径为400m的弯道,再作一段变加速运动后作匀 加速运动同时驶出弯道,出来后先作变速运动最后 在直道上作匀速运动,在该工况下的车辆具有较强 的纵横向耦合特性。 图4为在该复合工况下耦合控制器的控制输 出,在图4(a)中,t=5s时发动机转矩突然增大,这 主要是由于车辆进入弯道时,需要有额外的驱动力 来提供弯道运行所需的横向力,而为了保持车辆纵 向匀速运动,纵向力不能减小,故总的驱动力会有所 增大。反之,当车辆驶出弯道时总驱动力减小,如图 4(a),t=13s。前轮转角与车辆纵向速度及路径曲 率有关,当车辆进入弯道后路径曲率一定,故弯道中 前轮转角与纵向速度成正比,如图4(b),t=8s时车 辆进入弯道并加速,此时转角也增大。同理,t=16s g 量。0 辩 窭 萋。 稃 霪-0 一。时间/s 时间/0 (a)发动机转矩 (b)前轮转角 图4综合控制器输出控制量 车的纵、横向跟踪性能。从图6(a)中可以看出,纵 向位置动态误差被控制在±0.02m范围内,t=25s 时,前导车加速度为0,保持匀速运动,纵向位置误 差也迅速收敛于0。从图6(b)可以看出,横向位置 动态误差被控制在±0.05m。t=25s时,前方道路曲 率为0,前导车加速度为0,横向位置误差也迅速收 敛于0。从仿真结果可以看出,该综合控制器具有 良好的动、静态控制性能。 0.2圈 2 薹 .-:1 时间/s (b)车辆横向速度 图5观测值与仿真值对比 基 基 jj{】3 jj{】3 咖 咖 厦 足 舔 时间/s 时间/s (a)纵向位置误差 (b)横向位置误差 图6纵横向位置误差 6结论 (I)对车辆纵向运动和横向运动进行综合分析 研究,建立耦合动力学模型,利用滑模控制理论和动 态表面控制理论设计转向与驱动综合控制器,并对 其控制效果进行了仿真计算。结果表明该控制器具 有良好的动、静态控制性能,车辆纵、横向位置误差 都被控制在±0.05m范围内; (2)横向车速观测器的观测值与仿真结果比较 维普资讯 http://www.cqvip.com 2007(Vo1.29)No.8 李以农,等:车辆转向与驱动综合控制及横向速度观测器的设计 ・697・ (上接第685页) 案可行,车辆自动行驶操纵稳定性好,转向轮控制精 4结论 对无人驾驶电动游览车底盘系统进行了集成设 度约为±1.45。。 参考文献 [1]Lee Hyeongeheol,Tomizuka Masayoshi.Adaptive Vehicle Traction Force Control for Intelligent Vehicle Highway Systems(IVHSs) 计和研究,整车具有自动寻迹行驶和遥控行驶2种 行驶模式。在自动寻迹行驶时,车辆采用光电传感 器作为路径传感器来自动检测车辆的预定行驶轨 迹,采用dSPACE实时控制器实现了电动汽车轮毂 电机驱动系统、线控转向系统和电控液压制动系统 以及灯光喇叭系统等的初步集成控制,并采用超声 [J].IEEE Transactions Oil Industrial Electronics,2003,50(1):37 —47. [2] Steven E.Shladover,et a1.Automatic Vehicle Control Develop— ments in the PATH Program[J].IEEE Transactions on Vehicular eehnology,1991,40(1):l14—130. 波雷达传感器自动检测车前和车侧障碍物信息,实 现了车辆自动行驶中的被动防碰撞功能。在遥控行 驶时,车辆可根据遥控器的指令进行相应的动作。 经仿真试验和实车试验验证,该车集成控制技术方 [3] 余志生,汽车理论(第3版)[M].北京:机械工业出版社, 2001:116—118. [4] 米奇克.M.汽车动力学(c卷)[M].陈荫三,译.北京:人民交 通出版社,1997:145—146.