设计主题：单倒置摆控制系统的状态空间设计
班级：09级电气工程及其自动化3班
姓名：周立 学号：P091812927
日期：2012年5月12日星期六
现代控制理论课程设计
摘要.................................................................................................... 1 关键词: .............................................................................................. 1 1．引言.............................................................................................. 1 2.倒立摆数学模型的建立................................................................. 1 2.1．主题背景 ............................................................................. 1 2.2．抽象出研究对象 ................................................................. 2 3．对被控对象进行分析以及相应仿真.......................................... 3 3.1能控性分析 ............................................................................ 3 3.2稳定性分析 ............................................................................ 3 4.状态观测器的设计......................................................................... 4 4.1单倒置摆全状态反馈 ............................................................ 4 4.2 方案一：全维观测器的设计 ............................................... 5 4.3 方案二：降维观测器的设计 ............................................... 7 4.4 分析比较两种设计方案的性能 ......................................... 11 5. 结论............................................................................................. 11 参考文献.......................................................................................... 12
西北民族大学电气工程学院
2
现代控制理论课程设计
倒置摆控制系统状态的状态空间设计
倒置装置，能有效地反映诸如可镇定性、鲁
摘要:倒置摆控制系统是一个复杂的、棒性、随动性以及跟踪等许多控制中的关键
不稳定的、非线性系统，对倒置摆系统的研究能有效的反映控制中的许多典型问题，对单倒置摆，首先运用牛顿运动定律建立倒立摆系统的运动方程，以小车的位移，速度，摆杆与y轴正方向的夹角及摆角变化的速度作为四个状态变量，进而求出系统的状态空间描述，建立数学模型。其次运用状态反馈极点配置算法，由给定的控制要求求出状态反馈增益矩阵，将极点配置在控制要求的位置，另外考虑到系统的某些状态，如：小车速度和摆杆角速度不容易直接测量等，本文设计了全维状态观测器和降维状态观测器，对状态变量进行了重构并给出了利用Matlab仿真结果及分析。
问题，是检验各种控制理论的理想模型。倒立摆的研究具有重要的工程背景，对倒置系统的研究在理论上和方法论上都有深远的意义，近年来，新的控制方法不断出现，人们试图通过倒立摆这样一个典型的控制对象，检验新的控制方法是否有较强的处理多变量、非线性和绝对不稳定系统的能力，从而从中找出最优秀的控制方法。 倒立摆的控制方法在军工,航天和机器人领域有广泛的用途,另外其控制方法和思路在处理一般工业过程中亦有广泛的用途。机器人行走类似倒立摆系统，而机器人的关键技术至今仍未很好解决，倒立摆系统的稳定与空间飞行器控制和各类伺服平台的稳定有很大相似性，也是日常生活中所见到的任何重心在上、支点在下的控制问题的抽象。因此，倒立摆机理的研究具有重要的应用价值，成为控制理论中很重要的研究课题。
关键词: 倒立摆；状态反馈；极点
配置；状态观测器。
1．引言
倒立摆系统作为一个实验装置，形象直
观，结构简单，构件组成参数和形状易于改变，成本低廉；作为一个被控对象，它又相当复杂，就其本身而言，是一个高阶次、不稳定、多变量、非线性、强耦合系统，是控制理论的典型研究对象。只有采取行之有效的控制方法方能使之稳定。最初研究开始于二十世纪50年代，麻省理工学院（MIT）的控制论专家根据火箭发射助推器原理设计出一级倒立摆实验设备。倒立摆系统稳定效果非常明了，可以通过摆动角度、位移和稳定时间直接度量、控制好坏一目了然。近年来，控制理论不断发展，在其领域取得了一定的成就,形成了多种控制方法。控制理论发展的过程中，某一理论的正确性及在实际应用中的可行性需要一个按其理论设计的控制器去控制一个典型对象来验证。倒立摆就是这样一个被控制对象，倒立摆的种类不仅有简单的单机倒立摆，而且有多种形式的
2.倒立摆数学模型的建立
2.1．主题背景
如图1所示，为单倒置摆系统的原理
图。设摆的长度为L、质量为m，用铰链安装在质量为M的小车上。小车有一台直流电动机拖动，在水平方向对小车施加控制力u,相对参考系产生位移z。若不给小车施加控制力，则倒置摆会向左或向右倾倒，因此，
1
西北民族大学电气工程学院
现代控制理论课程设计
它是一个不稳定系统。控制的目的是，当倒
???? (M?m)z?ml??u (3) 置摆无论出现向左或向右倾倒时，通过控制
直流电动机，使小车在水平方向运动，将倒????z?l??g? (4) 置摆保持在垂直位置上。
图1 单倒置摆系统的原理图 联立求解式(3) 、式(4)，可得
??2.2．抽象出研究对象
为简化问题，工程上可以忽略一些次要因素。在本例中，我们为了简化问题，方便研究系统空间的设计问题，忽略了摆杆质量、执行电动机惯性以及摆轴、轮轴、轮与接触面之间的摩擦及风力。设小车的瞬时位置为z，倒置摆出现的偏角为θ，则摆心瞬时位置为(z?lsin?)。在控制力u的作用下，小车及摆均产生加速运动，根据牛顿第二定律，在水平直线运动方向的惯性力应与控制力u平衡，则有 Mdzdt22 z??mgM??1Mu (5)
?????(M?m)Mlg??1Mlu (6)
消去中间变量?，可得输入变量为u、输出变量为z的系统微分方程为
z(4)?(M?m)gMl??z?1M??u??gMlu (7)
选取小车的位移z及其速度z、摆角的位置
??及其角速度?作为状态变量，z为输出变
量，并考虑恒等式
dzdt??z，
d?dt???及式
?mddt22(z?lsinθ)?u
(5)、式(6)，可列出系统的状态空间表达式为 ?0??0?x???0?0??1000?0mg0??0??10???x??M1??0??10?????Ml????u(8a) ????即
?????2(M?m)z?mlθcosθ -mlθsinθ?u (1)
M0(M?m)gMl由于绕摆轴旋转运动的惯性力矩与重力矩平衡，因而有 [mddt22y??1000?x (8b)
式中
(z?lsinθ)]lcosθ?mglsinθ
即
?????22
?x??z??z???? ??Tzcos??l?cos??l?sin?cos??gsin?假定系统参数M = 1kg，m=0.1kg，l = 1m，g = 9.81m/s2，则状态方程中参数矩阵为 ?0??0A??0??0?10000?10110??0?1??0???0????1?b??0?????1??? (2)
式(1)、式(2)两个方程都是非线性方程，需作线性化处理。由于控制的目的是保持倒置摆直立，因此，在施加合适u的条件下，可
?，，
?均接近零，认为?、此时sin?≈?，cos??c??12000?
(9)
2
≈1，且可忽略??项，于是有
西北民族大学电气工程学院
现代控制理论课程设计
综合上述的分析，可抽象出系统的研究对象为：位移z、小车的速度z、摆角的位置
?先分析它的能控性。根据能控性的秩判据，并将式（9）的有关数据带入该判据，可得
rankM?rankb??AbAb2Ab?43?θ及其角速度?。系统的研究对象抽象成这四个变量后，接下来就可以根据前面的方程为这四个变量建立空间状态方程，并分析被控对象的特性。
此时倒置摆的状态空间模型表达式为： ?0?0???x?0??010??0????0?101?x???u （10）
001??0????0110???1?0 （11）
因此，单倒置摆的运动状态是可控的。换句话说，这意味着总存在一控制作用u,将非零状态x转移到零。 仿真： 代
码
：
A=[0,1,0,0,;0,0,-1,0;0,0,0,1;0,0,11,0];b=[0;1;0;-1];c=[1,0,0,0];d=0;
N=size(A);n=N(1); sys0=ss(A,b,c,d); S=ctrb(A,b)； f=rank(S); if f==n
disp('系统能控') else
disp('系统不能控') end
运行结果： 系统能控
y??1000?x
其系统的结构图如下：
3.2稳定性分析
由单倒置摆系统的状态方程，可求的其特征方程为：
图2 单倒置摆开环系统结构图
22?I?A??(??11)?0（12）
解得特征值为0,0，11，-11。四个特征值中存在一个正根，两个零根，这说明单倒置摆系统，即被控系统不稳定的。
仿真:采用matlab对被控对象进行仿真，如下图所示为倒摆没有添加任何控制器下四个变量的单位阶跃响应。如图可知，系统不稳定，不能到达控制目的。 代码：
A=[0,1,0,0,;0,0,-1,0;0,0,0,1;0,0,11,0];b=[0;1;0;-1];c=[1,0,0,0];d=0; sys0=ss(A,b,c,d); t=0:0.01:5;
[y,t,x]=step(sys0,t);
3
3．对被控对象进行分析以及相应仿真
3.1能控性分析
在建立完模型后我们需要对模型进行分析。作为被控制的倒置摆，当它向左或向右倾倒时，能否通过控制作用使它回复到原直立位置，这取决于其能控性。因此我们首
西北民族大学电气工程学院