Matlab汽车运动控制系统设计.doc

《Matlab汽车运动控制系统设计.doc》由会员分享，可在线阅读，更多相关《Matlab汽车运动控制系统设计.doc（23页珍藏版）》请在得力文库 - 分享文档赚钱的网站上搜索。

1、1绪论1.1选题背景与意义汽车已经成为人们日常生活不可缺少的代步交通工具，在汽车发达国家，旅客运输的60以上，货物运输的50以上由汽车来完成，汽车工业水平和家庭平均拥有汽车数量已经成为衡量一个国家工业发达程度的标志。进行汽车运动性能研究时一般从操纵性、稳定性和乘坐舒适性等待性着手。但近年来随着交通系统的日趋复杂，考虑了道路环境在内的汽车运动性能开始受到关注。因此，汽车运动控制系统的研究也显得尤为重要，在文中，首先对汽车的运动原理进行分析，建立控制系统简化模型，确定期望的静态指针(稳态误差)和动态指针(超调量和上升时间)。然后对汽车运动控制系统进行设计分析。从而确定系统的最佳静态和动态指针。2

2、论文基本原理分析2.1.1汽车运动横向控制（1）绝对位置的获得方法汽车横向方向的控制使用GPS(全球定位系统)的绝对位置信息。GPS信息的精度与采样周期、时间滞后等有关。为提高GPS的数据精度和平滑数据采用卡尔曼滤波对采样数据进行修正。GPS的采样周期为200ms相对应控制的周期采用50ms。另外考虑通信等的滞后、也需要进行补偿，采用航位推测法(dead reckoning)解决此问题。通过卡尔曼滤波和航位推测法推算出的值作为汽车的绝对位置使用来控制车速、横摆角速度等车辆的状态量。GPS的数据通过卡尔曼滤波减少偏差、通过航位推测法进行误差和迟滞补偿提高了位置数据推算的精度。（2）前轮转角变化量

3、的算出方法这里对前轮目标转角变化量()的算出方法作简要说明，横方向控制采用预见控制，可以从现在汽车的状态预测经过时间秒后的汽车位置，由秒后的预测位置和目标路径的位置可以算出秒后为沿着目标路径行驶所需要的汽车横摆角速度。这个数值前回馈或者从与现在值的目标路径的误差的反馈来推算前轮目标转角变化量(式(1) 式(1)式中为控制周期，,根据与现在目标路径的误差最小的原则来求解。2.1.2汽车运动纵方向的控制建立一个合理的传动系统模型是设计高性能汽车纵向运动控制系统的基础。目前纵向运动控制器设计过程中采用的传动系统简化模型主要有两类：一类是忽略传动系统的部分动态特性得到简化模型：另一类是通过对输入输出特

4、性辨识得到简化模型。本文借鉴文献，忽略传动系统的部分动态特性，将车辆简化为两轮模型，对于前轮驱动车辆，整车受力如图1所示。前后车轮运动方程分别为上式中和，分别为前后轮转动惯量(左右轮之和)，为后轮转速，和分别为前后车轮的垂直载荷(左右轮之和)，和分别为前后轮切向力(左右轮之和)，r为车轮半径，f为滚动阻力系数。对于汽车纵向运动控制系统，不会出现非常大的加减速度，采用线性化轮胎模型，得到切向力与滑移率关系为：。式中为轮胎纵向刚度，s为滑移率。驱动时s=l-v(rw)，制动时s=l-(rw)v。认为风阻作用于汽车质心，则前后轮垂直载荷分别为式中M为整车品质；a和b分别为前后轴到质心的距离，L=a+

5、b；为质心至地面的高度。整车运动方程为 ,式中风阻系数，A为等效迎风面积。发动机转矩、发动机转速、涡轮转速、半轴转矩、前后轮转速、车速7状态的非线性传动系统模型，在低频带内，发动机动态对传动系统特性基本无影响，如果控制系统只涉及较低频段可以忽略发动机动态。忽略了半轴、轮胎滑移以及载荷转移和发动机转矩，只包括发动机转速、车速2个状态。飞轮运动方程为 整车运动方程为 2.2汽车运动控制系统的模型简化分析考虑图2所示的汽车运行控制系统。如果忽略车轮的转动惯量并且假定汽车受到的摩擦阻力大小与运动速度成正比，方向与汽车运动方向相反，则该系统可以简化成简单的质量阻尼系统。根据牛顿运动定律，该系统的模型(亦

6、即系统的运动力方程)表示为： （3-1）其中，u为汽车的驱动力。为了得到控制系统的传递函数，对式(3-1)进行Laplace变换。假定系统的初始条件为零，则动态系统的Laplace变换为：由于系统输出是汽车的运动速度，用Y(S)替代V(s)，得到：因此汽车运动控制系统模型的传递函数为：2.3汽车控制系统PID控制器的校正根据阶跃响应曲线利用串联校正的原理以及参数变化对系统响应的影响，对静态和动态性能指针进行具体的分析，最终设计出满足我们需要的控制系统。系统在未加入任何校正环节时的开环传递函数，在MATLAB环境下对系统未加校正时开环阶跃响应曲线进行仿真绘制如图3阶跃响应曲线，图中系统的开环响应

7、曲线未产生振荡，其上升时间约100秒，稳态误差达到98，远不能满足跟随设定值的要求。图 3图 4（1）首先选择P校正，也就是在系统中加入一个比例放大器，为了大幅度降低系统的稳态误差，同时减小上升时间。P校正后系统的闭环传递函数为：此时控制系统的稳态值为。本系统的比例增益。即稳态值为800(50+800)=O.941，这样可以把系统的稳态误差降低到006左右。加入P校正后控制系统的死循环阶跃响应曲线如图3所示。图中，系统的稳态值约为0.941稳态误差约为5.9，这和最初的设计要求仍有差距，并且上升时间在7秒左右，不能达到设计的需要。因此我们选择PI校正。（2）加入PI校正器后系统的闭环单位反馈传

8、递函数为：考虑到的作用我们可以大幅度降低，取，在MATLAB环境下仿真得出的系统响应曲线如图4(中)所示。从图4(中)中可以得知，加入PI校正后系统的上升时间有所下降，但仍大于5秒。同时又产生了另一个问题，系统的超调量达到了2643这是使用积分器带来的副作用。因此适当地加入微分量。（3）可以选择PD校正，此时系统的闭环单位反馈传递函数为：鉴于对上升时间和稳态误差影响不大我们在P校正的基础上将降低少许，给出=10。系统响应曲线如图4(中)所示。（4）加入PID校正，此时系统的闭环单位反馈传递函数为： ，和的选择一般先根据经验确定一个大致的范围，然后通过MATLAB绘制的图形逐步校正。这里我们取=

9、700，=100，=100。得到加入PLD校正后系统的死循环阶跃响应如图4(右)所示。从图4(右)中可以得出，系统的静态指针和动态指针，已经很好的满足了设计的要求。上升时间小于5s，超调量小于8，约为667%。图 5根据系统的性能指针和一些基本的整定参数的经验，选择不同的PID参数进行模拟，最终确定满意的参数。这样做一方面比较直观，另一方面计算量也比较小，并且便于调整。2.4汽车运动控制系统根轨迹校正的设计过程为了减小系统的稳态误差，同时尽量减小超调量和上升时间的变化，达到满意的效果，我们需要从相位的角度来考虑，改变控制器的结构，从而想到相位滞后器的作用。相位滞后器的传递函数为：这样整个系统的

10、死循环传递函数就变成了：滞后控制器的零极点应设计成紧靠在一起，这样控制系统的稳态误差将减小/倍。根据上面的分析，将设计成-0.3，而等于-0.03。 图 6 图 7得到的根轨迹如图7中。在实轴的-0.35的位置附近选择期望点，得到图7所示的系统阶跃响应曲线。从图7中可以得知，这时的稳态误差已经满足设计要求。出现的少量超调亮是加入之滞后控制器的结果。死循环系统的超调量约为7.64%，满足小于8%的设计要求，上升时间约为2.5秒，以及稳态误差都已经满足设计要求。3对论文采用的理论和方法进行研究本论文利用MATLAB对简化后的汽车运动控制系统进行仿真，由于文中没有具体过程，图形也不能分辨精确值，扩写

11、时我进行具体分析并按照自己的理解进行仿真。文中简化后的汽车运动控制系统的开环传递函数为，其开环传递为一阶惯性系统。而全文没有提及汽车的质量m（经过后面的仿真，选取m值为800。）由于文中图形的分辨率问题，不能从文中读出精确值，仿真结果只能接近源图形，但已经足够完成要求，即对汽车运动控制简化模型的PID校正。3.1.1汽车运动控制简化模型传递函数仿真设计对原开环传递函数利用MATLAB进行单位阶跃输入响应的仿真。仿真程序如下：b=50;m=800;t=0:0.1:120;y=1;u=m b;sys0=tf(y,u);y1,t=step(sys0,t);sys1;plot(t,y1); grid;

12、xlabel(Time (seconds), ylabel(Step Response) 仿真结果图形如图8，图中上升时间明显偏大，大约60秒，而且稳态误差有98%，远远不能满足论文中的要求，但原文中没有对要求进行统一，所以下文中我选定上升时间小于5秒，超调量8%，稳态误差小于2%。图8 闭环传递函数单位阶跃输入响应3.1.2汽车运动控制系统P校正函数仿真设计论文对开环传递函数进行PID校正，文中是通过三步尝试得到最终PID校正参数。首先要减小系统的上升时间，进行P校正，即在开环系统中加入比例放大环节，P校正后系统的闭环传递环数为按文中数据取kp=800，原系统b=50，m=800。利用MAT

13、LAB进行闭环系统的单位阶跃输入响应仿真。仿真程序如下：kp=800;b=50;m=800;t=0:0.1:7;y=kp;u=m b+kp;sys1=tf(y,u);y1,t=step(sys1,t);sys1;plot(t,y1); grid;xlabel(Time (seconds), ylabel(Step Response) 仿真结果图形如下图9 图9 闭环传递函数单位阶跃输入响应具体分析：令比较系数得T=16/17，一阶系统的阶跃响应是一个按指数规律单调上升的过程，其动态性能指标中不存在超调量、峰值时间、上升时间等项。按一阶系统的过渡过程时间定义：，计算得，当增大系统的开环放大系数会

14、使T减小，减小。经过P校正后上升时间明显减小，但稳态误差约为5.9%，还是不能满足要求。3.1.3汽车运动控制系统PI校正函数仿真设计利用PI校正改进系统，PI控制不仅给系统引进一个纯积分环节，而且还引进一个开环零点。纯积分环节提高了系统的型别，从而有效的改善系统的稳态性能，但稳定性会有所下降。所以，比例加积分环节可以在对系统影响不大的前提下，有效改善系统的稳态性能。PI校正后的闭环传递环数为:利用MATLAB进行闭环系统的单位阶跃输入响应仿真程序如下：b=50;m=800;kp=200;ki=70;t=0:1:45;y=kp ki;u=m b+kp ki;sys2=tf(y,u);y2,t2

15、=step(sys2,t);plot(t2,y2);grid;xlabel(Time (seconds), ylabel(Step Response) 仿真结果图形如下图10图10 闭环传递函数单位阶跃输入响应仿真结果分析：此系统为具有一个零点的二阶系统，零点对此系统的动态性能分析参考教材自动控制原理分析如下：把上式写成为系统的单位阶跃响应=不难发现，,根据拉氏变换的微分定理由于，故 是典型二阶系统的单位脉冲响应(乘以系数)。一般情况下，零点的影响是使响应迅速且具有较大的超调量，正如图所示。零点越靠近极点，对阶跃响应的影响越大。3.1.4汽车运动控制系统PD校正函数仿真设计加入PD控制校正，闭

16、环传递函数为利用MATLAB进行闭环系统的单位阶跃输入响应仿真程序如下：b=50;m=800;kp=200;kd=10;t=0:0.5:20;y=kd kp;u=m+kd b+kp;sys3=tf(y,u);y3,t3=step(sys3,t);plot(t3,y3);grid;xlabel(Time (seconds), ylabel(Step Response) 图11 闭环传递函数单位阶跃输入响应系统单位阶跃响应的上升时间约为10秒，稳态误差为20%，稳态误差过大，需要继续校正。3.1.5汽车运动控制系统PID校正函数仿真设计对原系统进行PID校正，加入PID控制环节后传递函数为利用MA

17、TLAB进行闭环系统的单位阶跃输入仿真，经过多次比较取得kp=700，ki=100，kd=100。与论文结果一致。程序如下：b=50;m=800;kp=700;ki=100;kd=100;t=0:0.1:50;y=kd kp ki;u=m+kd b+kp ki;sys4=tf(y,u);y4,t4=step(sys4,t);plot(t4,y4);grid;xlabel(Time (seconds), ylabel(Step Response) 仿真阶跃输入响应结果如下图12 闭环传递函数单位阶跃输入响应观察图7，上升时间约3.5秒，超调量约5%，满足校正要求，虽然继续增大比例放大器 系数，阶

18、跃响应可以无限接近阶跃函数，但实际应用中由于实际器件限制不可能无限大。3.2汽车运动控制系统相位滞后器校正研究及仿真首先分析P校正后系统的闭环传递环数为：由margin函数可得系统的bode图如图13，由图像显示系统稳定。MATLAB仿真程序如下：m=800;b=50;kp=800;num=kp;den=m b+kp;sys=tf(num,den);margin(sys) 图13 P校正后的系统bode图相位滞后器的传递函数为：其bode图如图14，MATLAB仿真程序如下：p=0.03,z=0.3num=1 z;den=1 p;sys0=tf(num,den);margin(sys0)图14

19、 相位滞后器的bode图这样整个系统的死循环传递函数就变成了：利用MATLAB仿真其bode图，程序如下：b=50;m=800;kp=700;z=0.3;p=0.03;y=kp kp*z;u=m b+p+kp b*p+p*kp;sys5=tf(y,u);margin(sys5)仿真图形为下图图15 图15 相位滞后器校正后的bode图由图10 可以看出，由原传递函数和相位滞后器串联而成的系统的对数坐标时，两环节对数坐标的纵坐标相加减即可。但相位滞后器校正的有点在于中、高频幅值的衰减，使系统的截止频率左移（下降），从而获得足够的相角裕量。滞后校正的副作用是相角滞后，给系统附加一个负值相角，一致在

20、一定程度上影响了其优点的发挥。原汽车运动控制系统传递函数本来就是一个惯性系统，是稳定系统，所以相位滞后校正效果没有PID校正好。加入滞后控制器后的闭环阶跃响应曲线用MATLAB仿真，程序如下：kp=700;b=50;m=800;z=0.3;p=0.03;t=0:0.1:30;y=kp kp*z;u=m b+m*p+kp b*p+kp*z;sys52=tf(y,u);y,t=step(sys52,t);plot(t,y);grid;xlabel(Time (seconds), ylabel(Step Response)图16 加入滞后控制器后的系统闭环阶跃响应曲线观察图像，系统闭环阶跃响应上升时

21、间约为4.3秒，超调量约10%，超调量偏大，没有PID校正的效果好。3.3汽车运动控制系统相位滞后器校正研究及仿真根据给定的要求，利用的关系可以求得。为了留有余地，取。故。再由,按,所期望的闭环主导极点为利用MATLAB根轨迹仿真得原传递函数根轨迹如下图11图17 系统根轨迹图观察图像不难发现，此根轨迹于闭环主导极点无交点。需要加入一个零点和一个极点，且极点闭零点更靠近虚轴。图18结论从该系统的设计我们可以看到，应用PID控制是比较有效的，而且基本不用分析被控对象的机理，又根据，的参数特性以及MATLAB绘制的节约响应曲线进行设计即可。在MATLAB环境下，我们可以根据方针曲线来选择PID参数

22、。根轨迹是设计SISO系统控制器非常有效的方法，利用作图的手段来求出闭环极点的分布，避免了复杂的数学计算过程。通过根轨迹图，我们可以很容易的看出系统中摸个参数的变化对系统的闭环极点产生什么影响，进而如何影响系统的动态性能。该方法简便快捷，结果准确可靠，他是控制系统设计的优秀手段之一。本文创新点：在MATLAB环境下对汽车运动控制系统进行PID和根轨迹的设计和校正。参考文献1藤岡健彦，石田兼一ITS福祉车岡適用AAD2VANTY 2000 Symposium講演論文集C日本東京，200027302前学，藤岡健彦DGPS 利用絕對位置情報基自勤車自動運動a關研究A日本機械學會論文集c川崎：日本機械

23、學會，1999，2:3713783Kyongsu Y,Youngjoo C，Sejin L.A Throttle Brake Control Lawfor Vehicle Intelligent Cruise Control JFISITA World AutomotiveCongress2000:3203284Xu Z，Ioannou PAdaptive Throttle Control for Speed TrackingJVehicle System Dynamics,1994,(23):126-1305胡寿松自动控制原理(第四版)M北京:科学出版社,2001,4:1241666李友善自

24、动控制原理M北京：国防工业出版社,1987,6:102-2007张军锋，吴海峰.基于Matlab FIS工具箱的模糊自整定PID控制系统设计与实现J微电脑信息,2004,6:23258高国燊. 自动控制原理(第二版)M.广州：华南理工大学出版社，2005，5:8991.23 : 0版版大理理州广 二原原控 高高 :, 息电电 实实与制 定定模具具工 峰吴吴锋0 0 出防京控控友 0 出学四理控控自寿寿0 :( 0:0 . , : 會日川川學本 動自自車情情對 岡岡，0 0，日日講講 00 適祉祉 兼健健岡岡文正和和设根 制运运车下 ：一段段秀设设制控，准捷简简该能动动响何进么么生极统统对数数个

25、系看看很以图图根。算数数复了分分的环段的的利，效常统统 是。数数 来方方以我下下 在在计进应应响制 性参 和和 又象象被分本本，有是制制用，以我的的结 轴轴近更点，点点点点个要需需无极于于迹此难迹迹迹 轨数数原仿仿根 . 0 =点点环期期, . 故00.余有 .得可可的 /%，%求求定仿究究校滞统控控动好好效的 有有偏超超 量秒秒.间升响响阶，曲曲响环系系器制加加 ,) , ), ) * *+ * .: . .00 00 下下如真 线曲阶阶闭器器后好好好 有校位位相相系是统统惯就数数递系运运原挥点点响上定定一，个个加系滞滞是副正正滞裕相相获而）左 截截系使值值幅于点校校滞相相即减纵坐坐节两坐数

26、数的的联串相函函传出可 的的校滞滞相 下 ; = * + = .=.000 0 下下序程 真真 0 + + 00 ) 了成函环环的系 的位位相0 ) (=0 = =.=,下下序仿 ，图图 =为数数传器 统后后 ) =000 ;下如仿 定统统显图 如如 系系函 = 为环环传统系系析仿及及校后位控控车大大限不制限限实用用实但阶限限以跃数数器放放比继求校校， 超 约间，响输输位 函函闭闭如果响 ( ( ) ) ,;,( = 0 000 0 ; 下致一一论论0= 0 00= 比经真真跃跃单统闭进进 + + 数数后后制 入 进设设数 统动动汽正续续需过过误%为为态秒00时上响位位响输输阶 传 ) ) (

27、 ;,(), ( ,( + = 0 :0 0 00 00下序响响输位统统环 + =数数递传正正控设真函校校系控 大大响影跃跃，靠点点示正，大大有速使使是的况况 +)乘响位位的二二是 而应跃跃统统阶典 ，00 - = - 定分换换氏, =，现 =-+ + + + = 响响响 + + + 写下下下控材材参性性统此此零阶的的个具+ + += + + 析果响响入入位 递 下形 ,) ( ( ) ), , = =; 0= 00 0下如如真入入跃的环进 为为数环环后校能态系系改改下的不不统对节加加例以降降性稳稳性稳统效从从别系系提节节纯零一引，环环个引给制制 统改设设仿仿正 统统运 求求要不是是.为态态稳

28、减时上上校。 ，使 数环环系当 计计 ：程过过系按。时间值值量在不不性性其程的的单规一响的的系 / + = ( 令响响响跃单递 下下图 ( ) , ( 00 ;= 下如如真仿输位单单环环进 00=，=原0 据据 ( 数递闭统统正 放入统统开正行行进时统统要。正校最最试三通文文 行行函传设设设数统统制车.响输阶00函环 %于误误，量量超 小定定中下所所进对中中原，中论远远% 差差而0约约偏明时时图如图图 ,) ( ; )00 , )( :000 下序序真仿响阶阶行进 利0+ = 函函环设真递递传简简运汽正正 化控控车即要要够经形形近接真值值精中中不问问分图于于。0值，仿后 的及有文文统统性一传

29、=(数数传的统运的的化真真仿解解己按分进进写值值精不图，体体中于于行统统动汽化对 利利研行行方的采采求计满满都态稳稳 .时时上计的 ， .约的的循果器器控入是量量现求计足足误稳这这以以中线曲曲跃统所所得望选选附的.的的。 迹迹 图 图图 00 .设将分分面。000将态态稳控，起起成计极制制00 +( +0 =()了变变数传死系系 +0为数数递滞。的滞滞到从从构制控控虑度度位从，的到，间升调调减时，稳统统过过过校迹迹制运汽整于于且小小也面另直直面一一。的的意终拟进 的选选验数整整些和性性统 %为于于量量 间上求求的足足的已指针针静统统出可(从示右图图响循统统后 加到到0 0=， 里正逐图 过然然

30、范大个个经根根一的和和 )+ + )(为为函馈单单闭系正正 加加示所 线应。 出许少少 上的的 们们不差稳稳间对 + =(为为函递递单闭时时， 择量量分分入当用用的带用用这 到达统，问问生生又同于于但所时上系系 加得可(图示示中如线统统出真真境 在在0 00 ， 幅以我我的 + (为为函递递位的统校 正正 选此要计计到，左在上并并差差仍计和和， 为为稳 0约约稳系系图所线应应跃死死系后校校加左差差误统统可样 =000( 值值即0 增的。)0( / 态的的 + ) 为为传传统间升小小时态的降降大大，大个加统统就正正择首 求求求值跟跟不 误，0 时时荡荡产曲环环统系线线跃阶制线响环环时加统统下 在

31、传的的环何加加在。控的足足计终分分的进性态态静响响系系数数参原正正用线应校校校 统控汽汽+ ) )为为函的统统控车 到，(替替)，速运汽统 ( (=+为换 统统态，件的的定。 行行)-对递统统控到到力动动汽 - +为为为方力力系(的系系定顿牛牛统阻的的化可该，向运运向，正运与阻阻摩车车假动车车忽统制制运的的分简模制制运 = 为方 = 为为动态态状 速动动包，动转转荷滑、半。态略可可段及只控控，影影基系对对机动频频低统系系线态车转转轮轮矩半速速转转发发积风效效 系式 方运。高至为；=离离心轴前前 和质为为 - 别荷载后后心车车作 为为w ， 率率滑度刚刚为中中 =为为率滑向，胎胎性采采度的的非会

32、，系动车车。数滚，半 和右力力轮为 和，和左左直的的后分和 轮 )轮左动转转为 和 - - 别别程运车车所图图车辆车前前型两两化将特特动统动动略鉴本模模到辨辨出输过一：简简性态部部动忽是是两主模模系的用计设设运前前。的控运运汽高计计模传传合控向动动汽解解来的最最(径径路现 ,，制制为 式 )(变标标前推反反的径的与与或前前个这速横横的需需径目着 算算置置径路和的的 由车汽汽 时时测态在以以，预预采方，简方方的量量转轮前前方出化变度度精据据数提提偿迟误误测位过过差滤曼曼通的 态辆速速摆车来使使位汽为为的法位位和卡卡。此) 推用偿偿行行也后信信考。 周周应相相 期期采 。行数采采曼采平精 高为有有间、采采精信 信对)系定定 的向方获获位控控横车车.分理理文针态态态佳系而析析分分进控车车对)升升量(态态动态(指的确化化系立立，分理理运对，文文为显显研统动动汽此。始开开车车内环道道，趋日通随随年手待待等等乘定、纵纵研动动车。标达达发家衡衡成成数车均和和业车车完车由输，以0客客，发汽具具交少少缺生日成意意与与选绪23