单摆控制与仿真.docVIP

引言 在机械系统中，单摆运动是一种典型而具有代表性的运动之一，长期以来人们对单摆运动的运动方程以及周期公式都进行了大量的研究，对于有阻力的单摆运动的认识也一步步加深．然而，对于单摆运动的跟踪与控制，往往接触的很少．为了使两个不同系统的单摆实现同步跟踪，寻求控制力的控制规律以及最优解，本文在合理的假设下，针对该问题，建立了单摆追踪的模型．并利用线性系统的渐进稳定性原理及状态反馈控制对模型进行了求解，得出单摆控制力的最优解力，然后利用数学软件MATLAB进行了单摆运动的仿真模拟． 2 预备知识 ——线性系统的渐近稳定性 2．1 线性系统状态空间的基本概念 1)．:表征系统运动的信息和行为． 2)． 3)．: 设系统有个状态变量，用表示，而且把这些状态变量看做向量的分量，则向量称为状态向量，记为 ． 4)．个状态变量作为坐标轴所组成的n维空间． 5)．, 其中，是时间变量，是输入变量． 6）输出方程：描述系统输出量与系统状态变量和输入变量之间函数关系的代数方程称为输出方程，它表征了系统内部状态变化和输入所引起的系统输出变换，是一个变化过程．输出方程的一般形式为： ． 7）状态空间表达式：状态方程与输出方程的组合称为状态空间表达式，也称动态方程，它表征一个系统完整的动态过程，其一般形式为： ． 通常，对于线性定常系统，状态方程为 , 其中，表示维状态向量，表示系统内部状态的系数矩阵，称为系统矩阵，表示输入对状态作用的矩阵，称为输入（或控制）矩阵，表示输出对状态关系的矩阵，称为输出矩阵， 表示输入直接对输出作用的矩阵，称为直接转移矩阵，也称前馈系数矩阵． 由系统内部结构及其参数决定，体现了系统内部的特性，而则主要体现了系统输入的施加情况，通常情况下 ． 2．2线性定常连续系统的能控性 定义2．1 设，若存在一分段连续控制向量，能在内，将系统从任意的初态转移至任意终态，则系统完全能控． 定理2．1 系统完全能控的充要条件： , 其中，，称为能控矩阵． 2．3线性状态反馈控制律 线性状态反馈控制律为式中，是参考输入，称为状态反馈增益矩阵．系统动态方程变为： , 当时 , 式中，为闭环系统的系统矩阵． 闭环传递函数和特征方程为 ． 2．4 线性系统稳定性以及渐进稳定性理论 1）稳定性基本概念--平衡状态 自治系统：输入为的系统 ． 初态 的解为． 平衡状态： ． 2）李雅普诺夫意义下的稳定及渐进稳定 稳定：如果对每个实数都对应存在另一个实数满足 其中有： ， 且则称 是李氏意义下的稳定．． 渐近稳定： 是李氏意义下的稳定； ； 大范围内渐进稳定性：对 都有 ． 定理2．2[1]：对 维连续线性系统，系统内部稳定即渐进稳定的充分必要条件为系统矩阵所有特征值均有负实部即成立 ． 3 单摆运动问题的提出 对于单摆系统，摆球的初始状态、质量、摆长都影响着单摆的周期，对两个受空气阻力的单摆系统中的一个加以控制，使两个单摆系统的摆角渐近相等．此问题的关键在于使两个系统的摆角之间的误差趋向于零，运用线性系统的渐进稳定原理，建立模型，并利用数学软件MATLAB进行了单摆运动的仿真模拟． 研究此问题的具体要求： 两个单摆系统的摆球的初始状态、质量、摆长各不相同； 对其中一个加以控制力； 利用数学软件MATLAB对得到的控制律进行仿真，得出其图像． 4 问题分析与模型建立 4．1单摆跟踪问题分析 现有两个单摆系统，如图4-1所示，摆球质量分别为、，摆长分别为、，摆球的初始状态与竖直方向的夹角为、，根据单摆的性质可知，两个单摆系统的摆角不相等，在单摆4-1中施加一个控制力，使两个单摆达到渐进跟踪,即与之差趋向于0． 对单摆系统进行受力分析，可知 对于摆球有运动方程 （1） 又有 可知 整理可知 （2） 图4-1 单摆跟踪系统 对于摆球，有运动方程 ， （3） 同样也有 ， 可知 ， 整理推得 ． （4） 4．2 单摆跟踪问题模型的建立 令， ，再代入（2