倒立摆课程设计报告(20210212114807)

1、倒立摆课程设计报告班级：姓名：学号：同组人：目录第一章：倒立摆系统研究背景概述 2第二章：系统分析3第三章：控制系统基本方法仿真与实验73.1PID算法仿真与控制系统设计： 73.1.1 概述：73.1.2实验设计：83.1.3参数调试及仿真： 83.1.4输出实时控制： 103.2LQR算法仿真与控制系统设计： 123.2.1 概述：123.2.2实验设计：133.2.3参数调试及仿真： 133.2.4输出实时控制： 153.3频率法仿真与控制系统设计：163.3.1 概述：163.3.2实验设计及仿真： 163.3.3输出实时控制：21第四章：自选控制方法一模糊控制设计224.1模糊控制原

2、理概述： 224.2倒立摆模糊控制器的设计、调试及仿真： 244.2.1设计思想及模糊控制规则的建立： 244.2.2模糊控制系统的建立与调试： 29第五章:结束语33附录：336第一章：倒立摆系统研究背景概述倒立摆控制系统是一个复杂的、不稳定的、强耦合的非线性系统，是进行控 制理论教学及开展各种控制实验的理想实验平台。对倒立摆系统的研究能有效的 反映控制中的许多典型问题：如非线性问题、鲁棒性问题，稳定性问题、随动问 题以及跟踪问题等。最初研究开始于二十世纪 50年代，麻省理工学院（MIT）的 控制论专家根据火箭发射助推器原理设计出一级倒立摆实验设备。近年来，新的 控制方法不断出现，人们试图通

3、过倒立摆这样一个典型的控制对象，检验新的控 制方法是否有较强的处理多变量、非线性和绝对不稳定系统的能力。同时，其控 制方法在军工、航天机器人和一般工业过程领域中都有着广泛的用途，如机器人 行走过程中的平衡控制、火箭发射中的垂直度控制和卫星飞行中的姿态控制等。倒立摆系统按摆杆数量的不同，可分为一级，二级，三级倒立摆等，多级摆 的摆杆之间属于自由连接（即无电动机或其他驱动设备）。现在由中国的北京师 范大学李洪兴教授领导的“模糊系统与模糊信息研究中心”暨复杂系统智能控制 实验室采用变论域自适应模糊控制成功地实现了四级倒立摆。是世界上第一个成 功完成四级倒立摆实验的国家。倒立摆的控制问题就是使摆杆尽快

4、地达到一个平衡位置，并且使之 没有大的振荡和过大的角度和速度。当摆杆到达期望的位置后，系统能克 服随机扰动而保持稳定的位置。倒立摆系统的输入为小车的位移（即位置）和摆杆的倾斜角度期望值（或只 有角度），计算机在每一个采样周期中采集来自传感器的小车与摆杆的实际位置 信号，与期望值进行比较后，通过控制算法得到控制量，再经数模转换驱动直流 电机实现倒立摆的实时控制。直流电机通过皮带带动小车在固定的轨道上运动， 摆杆的一端安装在小车上，能以此点为轴心使摆杆能在垂直的平面上自由地摆动 。作用力u平行于铁轨的方向作用于小车，使杆绕小车上的轴在竖直平面内旋转 ，小车沿着水平铁轨运动。当没有作用力时，摆杆处于

5、垂直的稳定的平衡位置（ 竖直向下）。为了使杆子摆动或者达到竖直向上的稳定，需要给小车一个控制力 ，使其在轨道上被往前或朝后拉动。控制器的设计是倒立摆系统的核心内容，因为倒立摆是一个绝对不稳定的系 统，为使其保持稳定并且可以承受一定的干扰，需要给系统设计控制器，目前典 型的控制器设计理论有：PID控制、根轨迹以及频率响应法、状态空间法、最优 控制理论、模糊控制理论、神经网络控制、拟人智能控制、鲁棒控制方法、自适 应控制，以及这些控制理论的相互结合组成更加强大的控制算法。第二章：系统分析系统建模可以分为两种：机理建模和实验建模。实验建模就是通过在研究对 象上加上一系列的研究者事先确定的输入信号，激

6、励研究对象并通过传感器检测 其可观测的输出，应用数学手段建立起系统的输入-输出关系。这里面包括输入 信号的设计选取，输出信号的精确检测，数学算法的研究等等内容。机理建模就 是在了解研究对象的运动规律基础上，通过物理、化学的知识和数学手段建立起 系统内部的输入一状态关系。对于倒立摆系统，由于其本身是自不稳定的系统，实验建模存在一定的困难 但是忽略掉一些次要的因素后，倒立摆系统就是一个典型的运动的刚体系统，可 以在惯性坐标系内应用经典力学理论建立系统的动力学方程。下面我们采用其中 的牛顿-欧拉方法建立直线型一级倒立摆系统的数学模型。小车的物理模型如图2-1所示，我们不妨做以下假设：M小车质量M摆杆

7、质量b小车摩擦系数l摆杆转动轴心到杆质心的长度I摆杆惯量F加在小车上的力X小车位置摆杆与垂直向上方向的夹角0摆杆与垂直向下方向的夹角（考虑到摆杆初始位置为竖直向下）图是系统中小车和摆杆的受力分析图。其中，N和P为小车与摆杆相互作用力的水平和垂直方向的分量。注意：在实际倒立摆系统中检测和执行装置的正负方向已经完全确定，因而 矢量方向定义如图所示，图示方向为矢量正方向。【实际系统的模型参数如下】小车质量1.096 Kg摆杆质量 0.109 Kg小车摩擦系数0 .1N/m/sec摆杆转动轴心到杆质心的长度 0.25m摆杆惯量0.0034 kg*m*m建模的具体过程我们采用手写完成。第三章：控制系统基

8、本方法仿真与实验3.1PID算法仿真与控制系统设计：3.1.1概述：PID控制由比例单元（P）、积分单元（I ）和微分单元（D）组成。它由于用 途广泛、使用灵活，已有系列化产品，使用中只需设定三个参数（Kp, Ki和Kd） 即可。在很多情况下，并不一定需要全部三个单元，可以取其中的一到两个单元 ，但比例控制单元是必不可少的。20图3-1-1模拟PID控制系统原理框图PID控制器是一种线性控制器，它根据给定值rin（t）与实际输出值yout（t）构成控制偏差error(t)=ri n( t)-yout(t)PID的控制规律为:u (t) = k perror (t)Tierror (t)dtTd

9、 知。(t)0dt 丿也可以写成传递函数的形式G(s)=kp(1 丄 Tds)E(s)Tis其中，kp比例系数，Ti 积分时间常数；Td 微分时间常数。 简单的说来，PID控制器各校正环节的作用如下： 比例环节：成比例的反映控制系统的偏差信号 error（t），偏差一旦产生, 控制器立即产生控制作用，以减少偏差。 积分环节：主要用于消除静差，提高系统的无差度。积分作用的强弱取决 于积分时间常数Ti，Ti越大，积分作用越弱，反之越强。 微分环节：反映偏差信号的变化趋势（变化速率），并能在偏差信号变的 太大之前，在系统中引入一个有效的早期修正信号，从而加快系统的动作速度， 减少调节时间。3.1.2

10、实验设计：实验具体设计如下，图3-1-2为系统原理图，图3-1-3为封装下的PID控制器 内部结构图。Cert竝72宫OD-02125(8 26705Googol Linear 1-Stage Inverted Pendulum PID Central SimuhnkPID Contrsl 51 呵ILJJlIStep图 3-1-2图 3-1-33.1.3参数调试及仿真：我们首先按照传统PID参数整定方法调整参数的，骤是先让 Ki、Kd为0，只 调整Kp,使系统等幅震荡，然后根据等幅震荡的周期确定微分时间常数和积分 时间常数，再做些微调。这种方法在过程控制调节水箱时很有效。结果如下： Kp=4

11、0 Ki=0 Kd=0系统等幅震荡如图3-1-4所示，但按临界比例度法整 定参数并不理想，先比例，后积分的方法无论如何不能消除振荡，如图3-1-5。改变方法保持Kp调整Kd直到系统余差达到要求的范围内并达到尽量的小，并且上升时间至少小于要求调整时间的一半，之后开始调整Ki消除余差并且使系统达到要求。图 3-1-4图 3-1-5 Kp=40 Ki=O Kd=15系统最终稳定但有余差，我们下一步开始调整Ki，3-1-6图 3-1-6 逐渐增大Ki，当Kp=40 Ki=25Kd=15系统控制效果好，超调大约34%稳定时间4.4秒，无余差，符合要求，如图3-1-7，但是这种控制方法是无法控制 小车的位

12、置的，如图3-1-8图 3-1-73.1.4输出实时控制：在固高公司的实验仪器的模块内输入调整好的参数，倒立摆稳定立起来，实 时控制曲线如图3-1-9，上面是位移实时曲线，由于该系统不能控制位移，故需 要在小车靠近导轨边缘时用手轻轻碰一下摆杆，下面是角度实时曲线，手碰摆杆 可以看作是对系统施加扰动，角度实时曲线和摆杆的实际情况均可看出系统抗扰 动性能良好。on呼览鼻LiCS 图 3-1-93.2LQR算法仿真与控制系统设计: 321概述：线性二次型是指系统的状态方程是线性的，指标函数是状态变量和控制变量 的二次型。考虑线性系统的状态方程为：X(t) =Ax(t) Bu(t)y(t) =Cx(t

13、) Du(t)找一状态反馈控制律：u(t)二-Kx(t)，使得二次型性能指标最小化:Ttx (t)Q(t)x(t) u R(t)u(t)dt to其中，x(t)为系统的状态变量；tf、t0为起始时间与终止时间；S为终态约 束矩阵；Q(t)为运动约束矩阵；R(t)为约束控制矩阵。其中Q(t)、R(t)决定了 系统误差与控制能量消耗之间的相对重要性。为使J最小，由最小值原理得到最优控制为:*-1 Tu (t) - -R B P(t)x(t)式中，矩阵P(t)为微分Riccatti方程:TTP(t) P(t)A - A P(t) P(t)BR B P(t) -Q 的解。如果令终止时间tf :, P(

14、t)为一个常数矩阵，且P(t)=，因此以上的Riccatti方程简化为-PA-ARt) P(t)BR B P(t)-Q = 0。对于最优反馈系数矩阵K=RBTP(t)，使用Matlab中专门的求解工具lqr()来求取K。代码如下:clear;A= 0 1 0 0;0 0 0 0;0 0 0 1;0 0 29.4 0;B= 0 1 0 3;C= 1 0 0 0;0 0 10;D= 0 0 ;Q11=XX；Q33=xx；Q=Q1T0 0 0;0 0 0 0;0 0 Q33 0;0 0 0 0;R = 1;K = lqr(A,B,Q,R) 得到计算得到的K =XX XX XX XX把K矩阵的值代入到

15、下面的LQR控制仿真系统中即可以得到系统的的响应情 况。调试时取R= 1,下面就是确定Q11和Q33的值，其中Q11代表小车位置的权 重，Q33代表摆杆角度的权重。3.2.2实验设计：实验具体设计如下，图3-2-1为系统原理图：Googol Linear 1-Stage Inverted Pendulum LQR Control SimulinkLQR CantrsHerrn o-t- H niICR_JT = Ax+SuLLW w 1 j UB V, Ujy - CaDuDifit u-ib|Lm-&9r1h-teg&图 3-2-1图中的输入是位置的一个阶跃。3.2.3参数调试及仿真: 取Q

16、11=10 Q33=10，如图3-2-2可知超调量较小但稳定时间过长。可以使倒 立摆稳定。图 3-2-2 增强二者的控制作用，取Q11=1000 Q33=1000稳定时间大大缩短大约2.2秒, 但超调量大增约为60%如图3-2-3 。图 3-2-3 适当减小角度的权重，取 Q11=1000 Q33=200调整时间缩短到了 1.8秒 但超调 继续增大，超过了 100%，如图3-2-4图 3-2-4综合以上调试过程可知该系统可以同时控制角度和位移，但是角度的控制效 果比只控制角度的控制器略差。该控制器比较容易实现对倒立摆的控制，对Q11和Q33的取值不是很敏感，参数的选取可以根据实际情况进行权衡。

17、324输出实时控制:在固高公司的实验仪器的模块内输入调整好的参数，倒立摆稳定立起来，实 时控制曲线如图3-2-5，上面是位移实时曲线，下面是角度实时曲线，小车可以 左右移动不碰到导轨边缘。因mas日2图 3-2-53.3频率法仿真与控制系统设计: 331概述：系统对正弦输入信号的响应，称为频率响应。在频率响应方法中，我们 在一定范围内改变输入信号的频率，研究其产生的响应。频率响应可以采用 以下三种比较方便的方法进行分析，一种为伯德图或对数坐标图，伯德图采 用两幅分离的图来表示，一幅表示幅值和频率的关系，一幅表示相角和频率 的关系；一种是极坐标图，极坐标图表示的是当 从0变化到无穷大时向 量G(

18、j CD )的轨迹，极坐标图也常称为奈奎斯特图，奈奎斯特稳定判据使我们 有可能根据系统的开环频率响应特性信息，研究线性闭环系统的绝的稳定性 和相对稳定性。3.3.2实验设计及仿真：实验具体设计如下，图3-3-1为系统原理图：Googo/ LinearInverted Pendulum Frequency Response Control Simuiink图 3-3-1本次频率法设计基于系统的Bode图，可以精确设计系统的性能指标。但涉 及大量计算，因此采用手写完成，下面附上手写设计需要用到的图和代码。Bade DiagramLfirr|iirrb|JJLJ1LJ1111L1 Fr&queric

19、y tTacl/sec：-图 3-3-2m3opnNutbnBede LMagam23 3Frequency (racLsec)图 3-3-3 1i11. J 1 1 d 1 11.1J 11 1 1J 111R1111 1 1 1 1 |11 t 1 P P I1 f!、 - System: sysFrequency i rad/secj: 23.3MagnltLide-0.00337.i i I： i 11Ei. i i i i. o ii 11I. i. j. j .t n i .l tr r r 1 u i 11 r i i r t n jii/ L J a J 1J i i 1 LJ

20、 1i-Lr i r rirrr b r i i i jii严sysFrequency i rad/sec): 2B.3Phase (deg): -f25 a li I 1IH 4 1 1Il|厂 i|4Boae Diagramd1m!to*Frequency (rad/sec)图 3-3-4图 3-3-5Rodp Diagram 111TU1UFrequsney u rsd/sec22图 3-3-6下面是绘制图3-3-6的代码，其他绘制Bode图的代码仿此，不再赘述 num=0.02725;den=0.0102125 0 -0.26705;z=roots (nu m);p=roots(de

21、n);za=z;-8.953;-2.83;pa=p;-89.53;-0.283;k=980;sys=zpk(za,pa,k);bode(sys)图 3-3-720333输出实时控制：在固高公司的实验仪器的模块内输入计算好的零点极点，启动控制电机，倒 立摆稳定立起来，实时控制曲线如图 3-3-8，上面是位移实时曲线，下面是角度 实时曲线。由实时曲线图可知倒立摆的角度控制效果和抗扰动性能良好，但是这 种利用传递函数控制倒立摆的方法依然无法控制小车位移，需要在小车靠近导轨 边缘的时候轻碰一下摆杆。A也世图 3-3-829第四章：自选控制方法一模糊控制设计4.1模糊控制原理概述:“模糊”是人类感知万物

22、，获取知识,思维推理，决策实施的重要特征。“模糊”比“清晰”所拥有的信息容量更大，内涵更丰富，更符合客观世界。模糊控制 理论是由美国著名的学者加利福尼亚大学教授 Zadeh L A于1965年首先提出, 它以模糊数学为基础，用语言规则表示方法和先进的计算机技术，由模糊推理进 行决策的一种高级控制策略。原理图如图4-1，它充分展示了模糊技术的应用前景。控制量U图4-1图4-1为一般控制系统的架构，此架构包含了1974年,英国伦敦大学教授MamdaniE研制成功第一个模糊控制器,4个主要部分，即：模糊化、知识库、逻辑判断(推理机)及反模糊化模糊化(fuzzify )将输入值以适当的比例转换到论域的

23、数值，利用口语化变量来描述测量物理 量的过程，依适合的语言值(linguisticvalue )求该值相对之隶属度，此口语化变量我们称之为模糊子集合(fuzzy subsets )。将精确的输入量转化为模糊 量F有两种方法： 将精确量转换为标准论域上的模糊单点集。精确量x经对应关系G转换为标准论域x上的基本元素，则该元素的模糊单点集F为uF(u)=1 if u=G(x)uF(u) = Oifu 丰 G(h) 将精确量转换为标准论域上的模糊子集。精确量经对应关系转换为标准论域上的基本元素，在该元素上具有最大 隶属度的模糊子集，即为该精确量对应的模糊子集。(2) 知识库包括数据库(data bas

24、e)与规则库(rule base)两部分，其中数据库是提 供处理模糊数据之相关定义；而规则库则藉由一群语言控制规则描述控制目标和 策略。模糊控制规则建立在语言变量的基础上。语言变量取值为“大”、“中” 、“小”等这样的模糊子集，各模糊子集以隶属函数表明基本论域上的精确值属 于该模糊子集的程度。因此，为建立模糊控制规则，需要将基本论域上的精确值依 据隶属函数归并到各模糊子集中，从而用语言变量值(大、中、小等)代替精确值。 由于各变量取值范围各异，故首先将各基本论域分别以不同的对应关系，映射到 一个标准化论域上。通常,对应关系取为量化因子。为便于处理，将标准论域等分 离散化,然后对论域进行模糊划分

25、,定义模糊子集,如NB=ft方向大的偏差；NM负 方向中的偏差；NS方向小的偏差；Z0=于零的偏差；PS=E方向小的偏差；PM= 正方向中的偏差；PB=E方向大的偏差。同一个模糊控制规则库，对基本论域的模糊划分不同，控制效果也不同。具体 来说,对应关系、标推论域、模糊子集数以及各模糊子集的隶属函数都对控制效 果有很大影响。这3类参数与模糊控制规则具有同样的重要性，因此把它们归并为 模糊控制器的参数库，与模糊控制规则库共同组成知识库。NB=ft方向大的偏差；NM负方向中的偏差；NS方向小的偏差；ZO=fi于零 的偏差；PS=E方向小的偏差；PM正方向中的偏差；PB=E方向大的偏差。(3) 逻辑判

26、断模仿人类下判断时的模糊概念，运用模糊逻辑和模糊推论法进行推论，而得 到模糊控制讯号。此部分是模糊控制器的精髓所在。最基本的模糊推理形式(一 维)为:前提 1 IF A THENB前提2 IF A结论 THENB其中,A、A为论域U上的模糊子集,B、B为论域V上的模糊子集。前提1称为模糊蕴涵关系，记为 LB。在实际应用中，一般先针对各条规则进行推理,然后将各个推理结果总合而得到最终推理结果。(4) 解模糊化(defuzzify )将推论所得到的模糊值转换为明确的控制讯号，做为系统的输入值。目前常 用两种精确化方法：(1) 最大隶属度法。在推理得到的模糊子集中，选取隶属度最大的标准论 域元素的平

27、均值作为精确化结果。(2) 重心法。将推理得到的模糊子集的隶属函数与横坐标所围面积的重心 所对应的标准论域元素作为精确化结果。在得到推理结果精确值之后，还应按对应关系，得到最终控制量输出y。4.2倒立摆模糊控制器的设计、调试及仿真: 421设计思想及模糊控制规则的建立：控制倒立摆有四个主要因素，即小车的位置及速度，摆杆的角度及角速度， 如果对四个因素都加以考虑，假设对每个论域划分 7个模糊子集，只使用一个模 糊控制器，则控制规则将多达7八4=2401条，过于复杂难以实现。如果使用两个 模糊控制器，二者必将产生耦合，增大系统复杂程度和调试的难度，可能还会降 低控制效果。因此忽略次要因素，选择摆杆

28、角度和角速度为系统输入进行控制器 设计。控制规则的制定则采用类似 If (x1 is NB) and (x2 is NB) then (outputl is NB)的模糊控制规则进行控制，参考一些别人的经验对规则进行微调，具体规则 如下：7NBNMZOPSfNBNBNMNSNSNMNBNBNMNSNSZONSNMNMNSNSZOPSPS20NSNSZ0PSPSPMPSNSZ0PSPSPMZ0Z0PSPSPMPBPBPSPSPMPBPR图4-2用matlab的fuzzy指令建立模糊控制器如下： 在命令窗口中输入：fuzzy然后回车可得出如下图所示:图4-3模糊控制器设置界面然后对其各个变量进行设

29、置其步骤如下图4-4 :By FIS Editor: Iytfu7?y4nri methndminDr rrHl hndmaxmin.0QiE9atorimaxTDisfurzificiBrtioriccnt-ok)TCurrrrf VariUohlamej M 1丁沖einpuiRsnc)er-s可HtlpC)osysteiTi F,fytTuzzy; J inpiit勺! OLtput, ?nd M rule軒1“ EdEt Vtwv图4-4对输入变量X1进行设置如下图4-5所示:图4-5变量X2的设置如下图4-6所示：图4-6输出量的设置图4-7所示:图4-7模糊规则控制表的设置如下图4

30、-8所示：fed itc-n lytfuzzy1. If 1 b NEh end (m2 ia ND then (outpill b NB) H)? i r * 13. IT (X I4. tf(x15. If fx1 刊 ff (xl f. tt i1 a. tf(xi9.1fCx1博忡NM)theri 0iGl|)4rf 1is rm? and(x2 悅 ns) tn#n (autpir I ie nb； 1) is H甘卜 mnd(x2is0tn (output 1is H宙 snd (x2 is P5. then (ouipu;1 is NW. 1 lhiTiO (uulpinl is

31、m n NB ana (x2 A PC thn (output is Z0 an Ck2is NH) than (tuiputl isNBHOtq ir xi is rm) ra (xz s wsjnen mmiti is npf T)fend忖ft.NP.INSnolConnoctronOfrlC Name !vtfuzzyi、atk2境WoighrtDelete ruleIhoirr output isChange rule图4-8设置出来的效果图如图4-9，图4-10所示:Fili- Fdit Vit-rt/ OptionsSurface Viewer griM:Hef in口Lft;rs-arlyHViewer： lyfuzzyT Y ClnpuO gnch：Rip Edt 7iew OptionsDot ntw:z ami：outputlHek)Ckse图4-9output 1 -*4.6c*Q17图 4-1031422模糊控制系统的建立与调试：根据参考文献初步建立的系统框图如图 4-11:图 4-11其中支路是角度信号，支路是角速度信号，将它们一同输入模糊控制器 ，把输出信号进行放大后作用于用状态空间表示的控制对象（倒立摆），示波器 观察控制效果；进行反馈与输入进行比较。这种系统设计看上去符合原理，但在 调试