线性系统理论大作业小组报告-汽车机器人建模.docx
实用文档审定成绩:重庆邮电大学硕士研究生课程设计报告（线性系统理论）设计题目：汽车机器人建模学院名称：自动化学院学生姓名：专业:控制科学与工程仪器科学与技术班级：自动化1班、2班指导教师：蔡林沁填表时间：2017年12月实用文档重庆邮电大学实用文档摘要汽车被广泛的应用于城市交通中,它的方便、快速、高效给人们带来了很大便利,这大大改变了人们的生活.研制出一种结构简单、控制有效、行驶安全的城市用无人智能驾驶车辆,将驾驶员解放出来,是大大降低交通事故的有效方法之一,应用现代控制理论设计出很多控制算法，对汽车进行控制是非常必要的，本文以汽车机器人为研究对象，对其进行建模和仿真，研究了其模型的能控能观性、稳定性，并通过极点配置和状态观测器对其进行控制，达到了一定的性能要求。这些研究为以后研究汽车的自动驾驶和路径导航，打下了一定的基础。关键字:建模、能控性、能观性、稳定性、极点配置、状态观测器实用文档目录第一章绪论1第一节概述1第二节任务分工2第二章系统建模22系统建模22.1 运动学模型22.2 自然坐标系下模型42.3 具体数学模型6第三章系统分析73.1 能控性73.1.1 能控性判据73.1.2 能控性的判定83.2 能观性103.2.1 能观性判据103.2.2 能观测性的判定123.3 稳定性133.3.1 稳定性判据133.3.2 稳定性的判定14第四章极点配置154.1 极点配置概念154.2 极点配置算法154.3 极点的配置164.4 极点配置后的阶跃响应17第五章状态观测器185.1 概念195.2 带有观测器的状态反馈20实用文档5.3 代码实现215.4 极点配置和状态观测器比较23第六章总结25参考文献26附件（设计程序）27第一章绪论第一节概述进入20世纪,汽车被广泛的应用于城市交通中,它的方便、快速、高效给人们带来了很大便利,这大大改变了人们的生活.但是随着汽车数量的增加,交通事故的数量每年也不断增长,这严重威胁了人们的生命、财产安全,究其主要原因是由于驾驶员的疲劳驾驶造成的.研制出一种结构简单、控制有效、行驶安全的城市用无人智能驾驶车辆,将驾驶员解放出来,是大大降低交通事故的有效方法之一,也是国内外研究的热点之一。汽车机器人,其模型可简化成两轮的自行车模型,国内的学者在这方面作了很多深入的研究,应用现代控制理论设计出很多控制算法,取得很多成绩,但其中绝大多数应用环境是在室内,被跟踪轨迹已知,并且其控制方法是将车体的横向位移、纵向位移、纵向速度和转动的角速度等作为被控量,这在应用环境异常复杂城市交通系统中是难实现的。城市环境下的无人驾驶车由于速度较慢,因此比较安全可靠,它有广阔的应用前景,短期内，可作为城市大容量公共交通（如地铁等）的一种补充,解决城市区域交通问题,因此,城市环境下的无人驾驶车辆系统的研究已经成为目前的研究热点,但是,由于城市环境非常复杂,对感知和控制算法提出了很高的要求.第二节任务分工本设计由4位同学分工完成，每位同学的任务分工如表1-1所示:姓名学号班级设计分工自动化1班系统建模自动化2班能控性、能观性、稳定性分析自动化2班极点配置自动化1班状态观测器表1-1任务分工表第二章系统建模2系统建模汽车机器人是一种非线性、多变量、强耦合、参数不确定的复杂系统，是检验各种控制方法的一个理想装置，受到广大研究人员的重视，成为具有挑战性的课题之一。为了对其运动进行控制，就需要对汽车机器人进行数学建模。2.1 运动学模型汽车机器人其运动模型如图2-1：图21汽车机器人模型模型中相关参数及意义如下：前后轮间距离；入（力.两前轮中心点的速度；（力）两后轮中心”点的速度;6（0-前轮转向角;。(1)一为车体航向角；(力)-后轮中心点/距X轴距离；y(1)-后轮中心点AZ距y轴距离。假设两个轮子有相同的速度V(尽管在实际情况中，转弯时内轮比外轮慢)，一切情况似乎只在位于车轴中心线的两个虚拟轮子上发生口。如下图2-2：由速度合成规则有：VM(O=(Ocos(i)cos(0(1)系统演化的基本方程：6(t)=1va0)sin5(0i(2)方Q)=OMCoSeQ)(3)沙Q)=«)sin。)(4)由于前轮加速度和前轮转角的角速度不能无穷大，所以有增补方程：i)S=UiS(5)5(0=u2(t)(6)2.2 自然坐标系下模型自然坐标系的描述如下：原点：在被跟踪轨线上的某一被测到的点；X轴：按右手定则垂直X轴；Y轴：与过该被测点的切线重合,正方向与车体正方向相同。图23自然坐标系下的汽车机器人模型在汽车的运动过程中，能给予直接控制的有两种：前轮的加速度和方向盘的角度。此处6表示前轮与汽车中轴线之间的夹角，也就是方向盘的角度；汽车的位置需要3个量来表示：为汽车中轴线与水平轴线之间的夹角；汽车的位置(立用)(汽车后桥中心的位置)；以及汽车方向盘角度6。当汽车在未知道路形状时，切没有GPS可以定位时，对汽车的模型进一步研究。此时，没有了定位系统，只能以自身建立坐标系，y失去了意义，X仍然是与边缘的距离，将上页(1)式子代入(3)(4)式,并去掉y(t),得到：x(t)=VaCOS(Z)COS(Z)(1)A(t)=。4(I)Sin6(£)/£(2)方Q)=3(%)(3)6(。二为(4)2.3具体数学模型取状态变量如下：X1 (i)=叫=。的=。«)X4 (i) =5 Q)输入为：前轮加速度功 (力)前轮转角角速度“2 (力)输出为：后轮中心点M距X轴距离UiQ) =CG)Sin0«)前轮速度加=。(1)方向盘角度加= 6(。得到状态空间表达式为：AlQ) (0 勾Q) 勿4«)0va Q) cos COS。00000Va SilIb "00000000UlQ)_g«)_1/sin 0 (Z)0-1的 右 的 l40 0 001 00 1'u1 (ty若在元=(5,r2,7,0)m=(0,0)附近线性化该系统，并代入参数v = 7kmhL = 3m ,此时具体的状态空间模型为:FQ-0 7 02 (00 0 0 (00 0 0.14(力)._0 0 00 - 7/300为Q)- 2(t) 的Q) /4。).-0 0'0 01 00 1_的。)_gQ)- 22。) 的 KIQ) _-100y(t)=Ool000第三章系统分析在本章中，主要对系统进行能控性、能观性及稳定性的判定。其中，能控、能观性有三种判据，本文主要采用了秩判据和约当规范形判据来判定汽车机器人模型是否能控、能观。在稳定性判定中，有很多判定方法，如：特征值判据、李雅普罗夫判据、变量梯度法等，而本文主要采用的是特征值及极点是否有负实部来判定系统是否稳定。3.1 能控性能控性，如果系统内部每个状态变量都可以由输入完全影响，则系统的状态为能控。3.1.1 能控性判据(1)能控性格拉姆矩阵判据考虑连续时间线性时不变系统，状态方程为：i=x+fcu,x(0)=30为完全能控的充分必要条件是，存在时刻tBO,使如下定义的格拉姆(Gram)矩阵JlBBetdt为非奇异。(2)能控性秩判据对n维连续时间线性时不变系统，构成能控性判别矩阵：Q=B:j4B:Ji-1B则系统完全能控的充分必要条件为：ankQc=rankB:AB:-:A1B=Tl(3)能控性PHB秩判据对n维连续时间线性时不变系统，完全能控的充分必要条件为：ranksJ-A,Bn,VsEprankllA,B=>,i=lj2,-jn其中，和为复频域，(A=12,，n)为系统特征值。(4)能控性约当规范形判据对n维连续时间线性时不变系统，设n个特征值为;1”小,九为两两相异，则系统完全能控的充分必要条件为，对状态方程通过线性非奇异变换导出的约当规范形为：A100O00。一小00、OT000lv矩阵E不包含零行向量，即B的各个行向量满足：5«0J=IZIn3.1.2能控性的判定在本文汽车机器人建模的分析中，主要是用MATLAB对系统进行分析。在判断所建模型是否能控方面。MaHab仿真代码如下：SizeofA=Size（八）;Tc=ctrb(A,B);电能控性判定矩阵rTc=rank(Tc);电能控性判定矩阵的秩disp('能控性判定矩阵的秩，);rTcdispA的维数,);SizeofAif(rTc=SizeofA)disp('Thesystemiscontrollable,)elsedisp(,Thesystemisuncontrollable,)end其代码运行结果如图3.1所示。能控性判定矩陈的秩:A的维数：SizeofA=Thesystemiscontrollable图3.1能控性MATLAB判定结果由图3.1可得，矩阵A的维数和能控性判定矩阵的维数都是4,因此这个系统是能控的。同时，本文还采用了约当规范形判据，但是由于MATLAB运行出来的约当规范形矩阵不是标准型，无法判断系统的能控性，因此，在本小节中，得出的是进行极点配置后的系统的约当规范形矩阵，如图3.2所示。Gctrljordan=A=Xlx2x3x4Xl-2000x2O-1020Xlx2x3x4x3O-2-100yl0.32820.07110.024030x4O00-2y20001y30.080370.4767-0.032890B=ulu2D=Xl00.7319ulu2x201.067yl00x30-13.15y200x410y300图3.2极点配置后系统的约当规范形由图3.2可得，矩阵A分成了三个约当块。在判断能控性时，是观察每个约当块的末行，对应的B矩阵中的相应行，组成的矩阵是否满足行满秩。若满足，这表示系统完全能控；反之则不可控。根据图中的A、B矩阵，易得该系统是完全可控的。3.2能观性能观测性，如果系统内部每个状态变量都可以由输出完全反映，则系统的状态为能观测。3.2.1能观性判据（1）能观测性格拉姆矩阵判据考虑连续时间线性时不变系统，状态方程为：i=x,x（0）=xft,t0y=Cx为完全能控的充分必要条件是，存在时刻t>0,使如下定义的格拉姆（Gram）矩阵WO,t1AJ
