现代控制理论-大作业-倒立摆.docx
《现代控制理论-大作业-倒立摆.docx》由会员分享，可在线阅读，更多相关《现代控制理论-大作业-倒立摆.docx（25页珍藏版）》请在冰豆网上搜索。
摘要
倒立摆系统是一个复杂的、高度非线性的、不稳定的高阶系统，是学习和研究现代控制理论最合适的实验装置。
倒立摆的控制是控制理论应用的一个典型范例，一个稳定的倒立摆系统对于证实状态空间理论的实用性是非常有用的。
本文主要研究的是二级倒立摆的极点配置方法，首先用Lagrange方程建立了二级倒立摆的数学模型，然后对二级倒立摆系统的稳定性进行了分析和研究，并给出了系统能控能观性的判别。
基于现代控制理论中的极点配置理论，根据超调量和调整时间来配置极点，求出反馈矩阵并利用Simulink对其进行仿真，得到二级倒立摆的变化曲线，实现了对闭环系统的稳定控制。
关键词：
二级倒立摆；极点配置；Simulink
目录
1.绪论 1
2数学模型的建立和分析 1
2.1数学建模的方法 1
2.2二级倒立摆的结构和工作原理 2
2.3拉格朗日运动方程 3
2.4推导建立数学模型 4
3二级倒立摆系统性能分析 10
3.1稳定性分析 10
3.2能控性能观性分析 11
4状态反馈极点配置 12
4.1二级倒立摆的最优极点配置1 12
4.2二级倒立摆最优极点配置2 13
5.二级倒立摆matlab仿真 15
5.1Simulink搭建开环系统 15
5.2开环系统Simulink仿真结果 15
5.3Simulink搭建极点配置后的闭环系统 16
5.4极点配置Simulink仿真结果 17
5.4.1第一组极点配置仿真结果 17
5.4.2第二组极点配置仿真结果 19
6.结论 20
7.参考文献 21
附录一 22
1.绪论
倒立摆最初诞生于麻省理工学院，仅有一级摆杆，另一端铰接于可以在直线导轨上自由滑动的小车上。
后来在此基础上，人们又进行拓展，设计出了直线二级倒立摆、环型倒立摆、平面倒立摆、柔性连接倒立摆、多级倒立摆等实验设备。
在控制理论的发展过程中，为验证某一理论在实际应用中的可行性需要按其理论设计的控制器去控制一个典型对象来验证。
倒立摆系统作为一个实验装置，形象直观，结构简单，成本低廉；作为一个控制对象，他又相当复杂，同时就其本身而言，是一个高阶次、不稳定、多变量、非线性、强耦合系统，只有采取行之有效的控制方法才能使之稳定，因此倒立摆装置被公认为是自动控制理论中的典型实验设备。
综合文献资料，倒立摆控制的方法主要有：
PID控制，状态反馈，利用云模型，神经网络控制，遗传算法，自适应控制，模糊控制，变论域自适应模糊控制理论，智能控制等多种算法来实现倒立摆的控制。
本文主要构建二级倒立摆的数学模型的建立与分析，对倒立摆系统进行控制方法的研究。
本文就以下几个问题进行了论述。
1.二级倒立摆的数学模型的建立与分析。
在建模部分，首先采用拉格朗日方程推导数学模型，并对系统的可控性可观性进行分析，并分析倒立摆系统控制的难易程度。
2.二级倒立摆的控制原理及方法的研究。
本文主要采用状态反馈极点配置的方法对二级倒立摆进行研究。
3.采用Matlab语言进行数字仿真，分析仿真结果。
2数学模型的建立和分析
2.1数学建模的方法
所谓系统的数学模型就是利用数学结构来反映系统内部之间、内部与外部某些因素之间的精确的定量的表示。
它是分析、设计、预报和控制一个系统的基础，所以要对一个系统进行研究，首先要建立它的数学模型。
建立倒立摆系统的模型时，一般采用牛顿运动规律，结果要解算大量的微分方程组，而且考虑到质点组受到的约束条件，建模问题将更加复杂，为此本文采用分析力学方法中的Lagrange方程推导倒立摆的系统模型。
Lagrange方程有如下特点：
1.它是以广义坐标表达的任意完整系统的运动方程式，方程式的数目和系统的自由度是一致的。
2.理想约束反力不出现在方程组中，因此在建立运动方程式时，只需分析已知的主动力，而不必分析未知的约束反力。
3.Lagrange方程是以能量观点建立起来的运动方程，为了列出系统的运动方程，只需要从两个方面去分析，一个是表征系统运动的动力学量－系统的动能，另一个是表征主动力作用的动力学量－广义力。
因此用Lagrange方程来求解系统的动力学方程可以大大简化建模过程。
2.2二级倒立摆的结构和工作原理
如图2.1，系统包括计算机、运动控制卡、伺服机构、倒立摆本体（小车，上摆，下摆，皮带轮等）和光电码盘几大部分，组成了一个闭环系统。
光电码盘1将小车的位移、速度信号反馈给伺服驱动器和运动控制卡，下面一节摆杆（和小车相连）的角度、角速度信号由光电码盘2反馈回控制卡和伺服驱动器，上面一节摆杆的角度和角速度信号则由光电码盘3反馈。
计算机从运动控制卡中读取实时数据，确定控制决策（小车向哪个方向移动、移动速度、加速度等），并由运动控制卡来实现该控制决策，产生相应的控制量，使电机转动，带动小车运动，保持两节摆杆的平衡。
图2.1系统结构和工作原理图
2.3拉格朗日运动方程
拉格朗日提出了用能量的方法推导物理系统的数学模型，首先我们引入广义坐标，拉格朗日方程。
广义坐标：
系统的广义坐标是描述系统运动必需的一组独立坐标，广义坐标数等同于系统自由度数。
如果系统的运动用n维广义坐标q1,q2,…qn来表示，我们可以把这n维广义坐标看成是n维空间的n位坐标系中的坐标。
对于任一系统可由n维空间中的一点来表征。
系统在n维空间中运动形成的若干系统点连成一条曲线，此曲线表示系统点的轨迹。
拉格朗日方程：
Lq,q=Tq,q-Vq,q （2.1）
式中， —— 拉格朗日算子，
—— 系统的广义坐标，
—— 系统的动能，
—— 系统的势能。
拉格朗日方程由广义坐标和表示为:
ddt∂L∂qi-∂L∂qi=fi
（2.2）
式中，，——系统沿该广义坐标方向上的外力，在本系统中，设系统的三个广义坐标分别是。
2.4推导建立数学模型
在推导数学模型之前，我们需要几点必要的假设：
1.上摆、下摆及小车均是刚体；
2.皮带轮与传动带之间无相对滑动；传动皮带无伸长现象；
3.小车运动时所受的摩擦力正比于小车的速度；
4.小车的驱动力与直流放大器的输入成正比，且无滞后，忽略电机电枢绕组中的电感；
5.下摆转动时所受到的摩擦力矩正比于下摆的转动速度；
6.上摆运动时所受到的摩擦力矩正比于上摆对下摆的相对角速度；
二级倒立摆的运动分析示意图如图2.2
y
x
x
F
m1
m3
θ2
m2
M
图2.2二级倒立摆运动分析示意图
倒立摆系统参数如下：
小车系统的等效质量M=1.32Kg
摆杆1质量=0.04Kg 摆杆1转动中心到杆质心距离=0.09m
摆杆2质量m2=0.132Kg 摆杆2转动中心到杆质心距离l2=0.27m
质量块质量=0.208Kg 作用在系统上的外力F
摆杆1与垂直向上方向的夹角 摆杆2与垂直向上方向的夹角
首先，计算系统的动能：
（2.3）
小车动能：
TM=12Mx2 （2.4）
摆杆1动能：
（2.5）
式中，Tm1'--摆杆1质心平东动能
Tm1''--摆杆1绕质心转动动能
（2.6）
（2.7）
则
（2.8）
摆杆2动能：
（2.9）
式中，Tm2'--摆杆1质心平东动能
Tm2''--摆杆1绕质心转动动能
（2.10）
（2.11）
（2.12）
质量块动能：
（2.13）
因此，可以得到系统总动能：
（2.14）
系统的势能为：
（2.15）
至此得到拉格朗日算子：
（2.16）
由于因为在广义坐标上均无外力作用，有以下等式成立：
（2.17）
（2.18）
展开（2.17）、（2.18）式，分别得到（2.19）、（2.20）式
（2.19）
（2.20）
将（2.19）、（2.20）式对求解代数方程，得到以下两式
（2.21）
（2.22）
表示成以下形式：
（2.23）
（2.24）
取平衡位置时各变量的初值为零，
（2.25）
将（2.23）式在平衡位置进行泰勒级数展开，并线性化，令
（2.26）
（2.27）
（2.28）
（2.29）
（2.30）
（2.31）
（2.32）
得到线性化之后的公式
（2.33）
将在平衡位置进行泰勒级数展开，并线性化，令
（2.34）
（2.35）
（2.36）
（2.37）
（2.38）
（2.39）
（2.40）
得到
（2.41）
即:
（2.42）
（2.43）
现在得到了两个线性微分方程，由于我们采用加速度作为输入，因此还需加上一个方程:
（2.44）
取状态变量如下：
（2.45）
则状态空间方程如下：
（2.46）
将以下参数代入
求出各个值：
得到状态方程各个参数矩阵：
3二级倒立摆系统性能分析
3.1稳定性分析
二级倒立摆的特征方程为:
（3.1）
Matlab中，用函数eig（A）来计算系统矩阵的特征值，经过计算，系统的特征值为：
（3.2）
开环系统有两个开环极点位于平面右半平面上，所以系统是不稳定的。
同时，根据前面的状态空间表达式，在matlab中，用step（A,B,C,D）函数对系统的阶跃响应进行分析：
图1开环系统单位阶跃响应
从上图可以看出，在阶跃响应的作用下，系统是发散的。
3.2能控性能观性分析
对于线形状态方程
（3.3）
其能控性矩阵为：
（3.4）
求的秩
（3.5）
所以系统是完全能控的。
其能观性矩阵为：
C0=[C,CA,CA2,CA3,CA4,CA5]T （3.6）
求的秩
（3.7）
所以系统是完全能观的。
（代码见附录）
由上述计算结果可知，二级倒立摆系统是开环不稳定系统，但它的状态是完全能控且完全能观测的。
因此，可以对其实现闭环最优控制。
4状态反馈极点配置
4.1二级倒立摆的最优极点配置1
在式3.3中，A为6*6阵；B为6*1阵；C为3*6阵。
是一个单输入系统，且完全能控、能观测。
因此，可按照最优控制系统的极点配置方法进行设计。
对于一般控制系统，闭环主导极点的选取应使0.4≤ε≤0.8。
但二级倒立摆是一个特殊的高阶系统，稳定性是主要矛盾，因此可适当增加ε，即适当降低响应速度，来弥补系统稳定性要求。
相应在选择性能指标时，应适当减小系统的超调量。
对于二阶倒立摆系统，主要
升级会员 