一级倒立摆分析(共26页).doc

一级倒立摆的极点配置及仿真摘要倒立摆系统是一个复杂的、高度非线性的、不稳定的高阶系统，是学习和研究现代控制理论最合适的实验装置倒立摆的控制是控制理论应用的一个典型范例，一个稳定的倒立摆系统对于证实状态空间理论的实用性是非常有用的 本文主要研究的是一级倒立摆，首先应用动力学方程建立一级倒立摆的非线性数学模型，采用小偏差线性化的方法在平衡点附近局部线性化得到线性化的数学模型然后通过输入单位阶跃信号分析系统的开环稳定性，由线性化得到的状态方程判断系统的能控性和能观性，结合系统的稳定性条件、调整时间以及超调量找到合适的极点，运用极点的配置方法（Matlab的acker函数）算出状态反馈增益矩阵K，运用状态空间分析方法，采用状态反馈为倒立摆系统建立稳定的控制律，并判断加入反馈矩阵K后的能观性和能控性是否改变最后应用Matlab中的Simulink建立相应框图，得到输出变量水平位置和角度随时间的变化曲线，验证加入反馈矩阵K后一级倒立摆系统的稳定性关键词：一级倒立摆 状态反馈极点配置 Matlab Simulink目录1、一级倒立摆系统简介 倒立摆系统是一种很常见的又和人们的生活密切相关的系统，它深刻揭示了自然界一种基本规律，即自然不稳定的被控对象，通过控制手段可使之具有良好的稳定性。

倒立摆系统是一个非线性，强耦合，多变量和自然不稳定的系统它是由沿导轨运动的小车和通过转轴固定在小车上的摆杆组成的在导轨一端装有用来测量小车位移的电位计，摆体与小车之间由轴承连接，并在连接处安置电位器用来测量摆的角度小车可沿一笔直的有界轨道向左或向右运动，同时摆可在垂直平面内自由运动直流电机通过传送带拖动小车的运动，从而使倒立摆稳定竖立在垂直位置图1一级倒立摆装置简图由图1中可以看到，倒立摆装置由沿导轨运动的小车和通过转轴固定在小车上的摆体组成导轨的一端固定有位置传感器，通过与之共轴的轮盘转动可以测量出沿导轨由图中可以看到，倒立摆装置由沿导轨运动的小车和通过转轴固定在小车上的摆运动的小车位移；小车通过轴承连接摆体，并在小车与摆体的连接处固定有共轴角度传感器，用以测量摆体的角度信号；并通过微分电路得到相应的速度和角速度信号；导轨的另一端固定有直流永磁力矩电机，直流电机通过传送带驱动小车沿导轨运动，在小车沿导轨左右运动的过程中将力传送到摆杆以实现整个系统的平衡倒立摆的种类很多，有悬挂式倒立摆、平行式倒立摆、和球平衡式倒立摆；倒立摆的级数可以是一级，二级，乃至更多级控制方法也是多种，可以通过模糊控制，智能控制，PID控制，LQR控制等来实现倒立摆的动态平衡，本文介绍的是状态反馈极点配置方法来实现一级倒立摆的控制。

2、一级倒立摆系统的数学模型2.1、数学模型的建立 一级倒立摆系统示意图如下图所示，系统由小车、小球和轻质杆组成倒摆通过转动关节安装驱动小车上，杆子的一端固定在小车上，另一端可以自由地左右倒下通过对小车施加一定的外部驱动力，使倒摆保持一定的姿势 图2 一级倒立摆系统示意图 一级倒立摆系统所用到的各变量的取值及其意义如下表1所示：表1 各变量的取值及其意义变量符号变量意义变量取值 小车质量2.0kg 小球的质量0.1kg 倒摆的杆长0.5m 重力加速度9.81m/s^2(t)倒摆偏离垂直方向的角度角度随时间变化 u(t)小车受到的水平方向 的驱动力驱动力 u随时间变化2.2、运动分析 假设轨道是光滑的，忽略摆杆的质量，系统所受的外力包括小球受到的重力和小车水平方向的驱动力 u x(t)和(t)分别表示小车的水平坐标和倒摆偏离垂直方向的角度由此分析可知一级倒立摆有两个运动自由度：一个是沿水平方向运动（直线运动）；另一个是绕轴线的转动（旋转运动）。

2.2.1、沿水平方向运动（直线运动） 通过受力分析，由牛顿第二运动定律，系统的运动满足下面的方程：XYFyFxGx水平方向受到的合外力竖直方向受到的合外力 图3 倒立摆系统水平方向受力分析图 X轴方向： ① 小球的重心坐标满足： ② 将小球的重心坐标代入①式得： ③联立①②③式得：2.2.2、绕轴线的转动（旋转运动）XYFyFxGxL 图4 倒立摆系统转动受力分析图 小球的力矩平衡方程： ④ ④式中、分别为： ⑤将⑤式代入④式整理得：最后得到倒立摆系统的动力学方程为： ⑥ 显然该系统为明显的非线性系统。

但是对小车施加驱动力的目的是要保持小球在垂直方向的姿态，因此，我们关注的是小球在垂直方向附近的动态行为变化，为此将系统在该参考位置（＝0）附近进行线性化处理2.3、模型转化(微分方程→状态方程) 由倒摆系统的动力学模型⑥式，取如下状态变量： 可得到倒摆系统的状态方程：2.4、状态方程的线性化 采用Jacobian 矩阵线性化模型，最终得到系统的线性化状态方程为： 假定系统的输出为倒摆的角度和小车的x轴坐标，则系统的输出方程为： 3、状态空间极点配置3.1、系统开环稳定性分析 由状态方程的标准形式： 结合表1中各变量的值可得： 上面已经得到系统的状态方程式，对其进行阶跃响应分析，在MATLAB 指令区中键入以下命令：A=[0 1 0 0;20.601 0 0 0;0 0 0 1;-0.4905 0 0 0 ];B=[0 ;-1; 0;0.5 ];C=[1 0 0 0;0 0 1 0];D=[0;0];step(A,B,C,D);图5 系统稳定性仿真图可以看出，在单位阶跃响应作用下，小车位置(x)和摆杆角度(θ)都是发散的。

即系统是不稳定的3.2、开环系统的能控性分析 采用状态反馈对系统进行任意配置极点的充要条件是系统完全能控，因此本小节对所建立的系统状态方程运用Matlab进行能控性的分析系统的能控性是指系统的输入能否控制状态的变化对于n阶线性定常系统：能控性矩阵为当rankUc=n时，系统状态完全能控，否则系统不能控在Matlab中，可利用ctrb()函数直接求出能控性矩阵，从而确定系统的状态能控性，它的调用格式为：Uc=ctrb(A,B) 在MATLAB 指令区中键入以下命令：A=[0 1 0 0;20.601 0 0 0;0 0 0 1;-0.4905 0 0 0 ];B=[0 ;-1; 0;0.5 ];Uc=ctrb(A,B);n=4;if(n==rank(Uc))disp('系统能控')End其结果为：系统能控可以看出，系统的状态完全可控性矩阵的秩等于系统的状态变量维数，系统的输出完全可控性矩阵的秩等于系统输出向量y 的维数，所以系统可控，因此可以对系统进行控制器的设计，使系统稳定3.3、开环系统的能观性分析控制系统大多数采用反馈控制形式在现代控制理论中，其反馈信息是由系统的状态组合而成。

但并非所有的系统的状态变量在物理上能侧取到，于是提出能否通过对输出的测量获得全部状态变量的信息，这便是系统的观测问题对于n阶线性定常系统：能观测性矩阵为：当rankVc=n时，系统的状态完全能观测，否则系统状态不能观测在Matlab中，可利用obsv()函数直接求出能观性矩阵，从而确定系统的状态能观测性，它的调用格式为：Vc=obsv(A,C)在MATLAB 指令区中键入以下命令：A=[0 1 0 0;20.601 0 0 0;0 0 0 1;-0.4905 0 0 0 ];C=[1 0 0 0;0 0 1 0];Vc=obsv(A,C);n=4;if(n==rank(Vc)) disp('系统能观')End其结果为：系统能观系统的状态完全能观性矩阵的秩等于系统的状态变量维数，系统的输出完全能控性矩阵的秩等于系统输出向量y 的维数，所以系统能观3.4、系统极点配置 下面采用极点配置的方法计算反馈矩阵 1、检验系统可控性 由上节的系统可控性分析可以得到，系统的状态完全可控性矩阵的秩等于系统的状态维数4，系统的输出完全可控性矩阵的秩等于系统输出向量的维数2，所以系统可控 2、计算特征值 综合指标为：输出超调量 ；超调时间 ； 系统频宽 ； 跟踪误差 （对阶跃），（对速度）。

确定希望的极点：显然,希望的极点n=3,选其中一对为主导极点和,另一个为远极点,并且认为系统的性能主要是由主导极点决定的,远极点只有微小的影响 根据二阶系统的关系式，先定出主导极点 式中和为此二阶系统的阻尼比和自振频率可以导出：①由可得从而有于是选②由得：③由和已选的②的结果比较可取这样便定出了主导极点为：远极点应选择得使它的实部大于5倍的主极点的实部，现取Re=5Re，因此根据要求，并留有一定的裕量（设调整时间为2秒），我们选取期望的闭环极点： 其中u1=-35，u2=-35，u3=-7.07-7.07j，u4=-7.07+7.07j，u1，u2是一对具有 的主导极点，u3，u4位于主导极点的左侧，因此其影响较小所以，可满足快速性和阻尼的要求同理，取，将带入得到，远极点应选择得使它的实部大于5倍的主极点的实部，现取Re=5Re，得到另一组期望的闭环极点： 其中x1=-10，x2=-10，x3=-2-2j，x4=-2+2j，x1，x2是一对具有 的主导极点，x3，x4位于主导极点的左侧，因此其影响较小所以，可满足快速性和阻尼的要求。

其中主导极点决定系统的性能,远极点只有微小的影响，根据系统的综合指标关。