二阶倒立摆实验报告.docx

研究生课程实验报告 二阶倒立摆实验 PAGE 8 PAGE 1 研究生课程实验报告 课程名称：线性系统 实验名称：平面二级倒立摆实验 班级： 12S0441 学号：12S104057 姓名：白 俊 林 实验时间： 2012 年12 月 21 日 控制科学与工程教学实验中心 实验目的 熟悉Matlab/Simulink仿真； 掌握LQR控制器设计和调节； 理解控制理论在实际中的应用。 倒立摆研究的意义是，作为一个实验装置，它形象直观，简单，而且参数和形状易于改变；但它又是一个高阶次、多变量、非线性、强耦合、不确定的绝对不稳定系统的被控系统，必须采用十分有效的控制手段才能使之稳定。因此，许多新的控制理论，都通过倒立摆试验对理论加以实物验证，然后在应用到实际工程中去。因此，倒立摆成为控制理论中经久不衰的研究课题，是验证各种控制算法的一个优秀平台，故通过设计倒立摆的控制器，可以对控制学科中的控制理论有一个学习和实践机会。 实验内容 1）建立直线二级倒立摆数学模型 对直线二级倒立摆进行数学建模，并将非线性数学模型在一定条件下化简成线性数学模型。对于倒立摆系统，由于其本身是自不稳定的系统，实验建立模型存在一定的困难，但是经过小心的假设忽略掉一些次要的因素后，倒立摆系统就是一个典型的运动的刚体系统，可以在惯性坐标系内应用经典力学理论建立系统的动力学方程。对于直线二级倒立摆，由于其复杂程度，在这里利用拉格朗日方程推导运动学方程。 由于模型的动力学方程中存在三角函数，因此方程是非线性的，通过小 角度线性化处理，将动力学非线性方程变成线性方程，便于后续的工作的进行。 2）系统的MATLAB仿真 依据建立的数学模型，通过MATLAB仿真得出系统的开环特性，采取相应的控制策略，设计控制器，再加入到系统的闭环中，验证控制器的作用，并进一步调试。控制系统设计过程中需要分析内容主要包括得出原未加控制器时系统的极点分布，系统的能观性，能控性。 3）LQR控制器设计与调节实验 利用线性二次型最优（LQR）调节器MATLAB仿真设计的参数结果对平面二阶倒立摆进行实际控制实验，参数微调得到较好的控制效果，记录实验曲线。 4）改变控制对象的模型参数实验 调整摆杆位置，将摆杆1朝下，摆杆2朝上修改模型参数、起摆条件和控制参数，重复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 = 0 0 0 1.0000 0 0 0 0 0 0 1.0000 0 0 0 0