二阶倒立摆实验报告Word格式文档下载.docx
《二阶倒立摆实验报告Word格式文档下载.docx》由会员分享，可在线阅读，更多相关《二阶倒立摆实验报告Word格式文档下载.docx（14页珍藏版）》请在冰豆网上搜索。
1.
实验目的
1）熟悉Matlab/Simulink仿真；
2）掌握LQR控制器设计和调节；
3）理解控制理论在实际中的应用。
倒立摆研究的意义是，作为一个实验装置，它形象直观，简单，而且参数和形状易于改变；
但它又是一个高阶次、多变量、非线性、强耦合、不确定的绝对不稳定系统的被控系统，必须采用十分有效的控制手段才能使之稳定。
因此，许多新的控制理论，都通过倒立摆试验对理论加以实物验证，然后在应用到实际工程中去。
因此，倒立摆成为控制理论中经久不衰的研究课题，是验证各种控制算法的一个优秀平台，故通过设计倒立摆的控制器，可以对控制学科中的控制理论有一个学习和实践机会。
2.实验内容
1）建立直线二级倒立摆数学模型
对直线二级倒立摆进行数学建模，并将非线性数学模型在一定条件下化简成线性数学模型。
对于倒立摆系统，由于其本身是自不稳定的系统，实验建立模型存在一定的困难，但是经过小心的假设忽略掉一些次要的因素后，倒立摆系统就是一个典型的运动的刚体系统，可以在惯性坐标系内应用经典力学理论建立系统的动力学方程。
对于直线二级倒立摆，由于其复杂程度，在这里利用拉格朗日方程推导运动学方程。
由于模型的动力学方程中存在三角函数，因此方程是非线性的，通过小角度线性化处理，将动力学非线性方程变成线性方程，便于后续的工作的进行。
2）系统的MATLAB仿真
依据建立的数学模型，通过MATLAB仿真得出系统的开环特性，采取相应的控制策略，设计控制器，再加入到系统的闭环中，验证控制器的作用，并进一步调试。
控制系统设计过程中需要分析内容主要包括得出原未加控制器时系统的极点分布，系统的能观性，能控性。
3）LQR控制器设计与调节实验
利用线性二次型最优（LQR）调节器MATLAB仿真设计的参数结果对平面二阶倒立摆进行实际控制实验，参数微调得到较好的控制效果，记录实验曲线。
4）改变控制对象的模型参数实验
调整摆杆位置，将摆杆1朝下，摆杆2朝上修改模型参数、起摆条件和控制参数，重复3的内容。
3.实验步骤
1）倒立摆系统模型
在忽略了空气流动，各种摩擦之后，可将倒立摆系统抽象成小车、匀质杆和质量块组成的系统，如图1所示。
图1直线两级倒立摆物理模型
下面利用拉格朗日方程推导运动学方程。
拉格朗日方程为：
则
同样可以求出
因此，可以得到系统的总动能为：
系统的总势能为：
从而拉格朗日算子：
由于因为在广义坐标
上均无外力作用，有以下等式成立：
展开（17），（18）式，分别得到（19），（20）式
将（19），（20）式对
求解代数方程，得到以下两式
表示成以下形式：
取平衡位置时各变量的初值为零，
将（23）式在平衡位置进行泰勒级数展开，并线性化，令:
带入（21）式，得到线性化之后的公式
将（24）式在平衡位置进行泰勒级数展开，并线性化，令
带入（22）式，得到
即：
现在得到了两个线性微分方程，由于我们采用加速度作为输入，因此还需加上一个方程
取状态变量如下：
由（33），（41），（42）式得到状态空间方程如下：
其中直线两级倒立摆系统参数为：
小车质量2.32kg
摆杆1质量0.04kg
摆杆2质量0.132kg
质量块质量0.208kg
摆杆1与垂直向上方向的夹角
摆杆2与垂直向上方向的夹角
摆杆1到转动中心质心的距离0.09m
摆杆1到转动中心质心的距离0.27m
作用在系统上的外力
由以上方程，将以下参数代入
求出各个
值：
得到状态矩阵为：
A=
0001.000000
00001.00000
000001.0000
000000
086.6907-21.6172000
0-40.311239.4500000
B=
0
1.0000
6.6402
-0.0877
C=
100000
010000
001000
000100
000010
000001
D=[000000]'
2）根据建模结果仔细计算并寻找合适的理论控制器参数。
设R=1，Q=diag（[200300300000]），利用matlab提供的lqr函数，可求得：
K=
14.1421103.1881-174.169115.26823.0199-28.2451
3）进入matlabcommand窗口，键入仿真文件，进行仿真实验
利用固高公司提供的Simulink方框图，输入控制参数k，进行实物仿真，并通过调整Q的值来调整k的值，以达到控制系统的设计要求。
通过调节参数请仔细观察思考控制器参数对系统瞬态响应和稳态响应的影响。
找到几组合适的控制器参数作为实际控制的参数。
4）倒立摆系统实物调试具体步骤如下：
将小车推到导轨的中央，并且使摆杆处于自由下垂的静止状态，
给小车的驱动器的电源接通电源，进入MATLAB的SIUMLINK中，调出实物仿真文件，填入设计的控制器参数（0,pi,pi），编译，连接实物，双手将倒立摆竖直的缓慢的立起，倒立摆进入到与竖直方向夹角小于10度的范围内，控制器启动，观察控制器的控制效果。
成功后，从新设计控制器，并使参考位置为设为（0,0,pi），重复（0,pi,pi）试验过程。
5）将保存的实验数据画出图形，分析实际控制效果与仿真曲线的区别。
4.实验数据和曲线
实验一中，实验数据为：
Q=diag（[200300300000]）
实验仿真曲线为：
图2参考位置为设为（0，pi，pi）仿真图
实验实物曲线为：
图3参考位置为设为（0，pi，pi）实验曲线
实验二数据为：
k=
-14.1421-55.3918121.8639-13.4838-5.822720.6980
Q=diag（[200300100000]）
-14.1421-56.2117124.5101-13.6940-5.880221.0735
图4参考位置为设为（0，0，pi）仿真图
实物仿真曲线为：
图5参考位置为设为（0，0，pi）实验曲线
5.实验结果分析
从仿真和实验曲线来看两个实验都达到了预期目标。
两实验的仿真曲线都约在2.5S左右达到平衡位置，而实际结果来看，第一个实验在12S左右才达到平衡，第二个实验相对较好，摆杆在5S左右达到平衡，但是小车位置确一直在滑动。
设备实际运行结果没有仿真结果好，这说明模型与实际系统是存在差别的。
6.实验收获和新实验内容设想
相比其他实验而言，这个实验有很多特别的地方：
首先，本实验有一定的危险性，在手动立起来时小车带着二阶倒立摆快速的移动，容易伤人；
因此实验时需要特别小心，同时也要注意队员之间的默契配合；
其次，本实验为二阶摆，摆杆不能自己立起来，需要手动扶起来，在摆杆快到目标角度时，手需要特别的轻并且要稳，否则小车速度过高系统停止工作，导致实验失败。
通过本实验，从新复习了Matlab/Simulink环境下的控制系统设计，了解了控制系统设计的过程，加深了线性系统理论知识的理解，体会了现代控制的魅力。
【下载本文档，可以自由复制内容或自由编辑修改内容，更多精彩文章，期待你的好评和关注，我将一如既往为您服务】
升级会员 