倒立摆系统地建模及Matlab仿真Word格式文档下载.docx

1、于是有 联立求解可得2.2列写系统的状态空间表达式。选取系统变量， 则即代入数据计算得到：3.设计控制器3.1判断系统的能控性和稳定性，rank（）=4,故被控对象完全可控由特征方程 解得特征值为 0，0，。出现大于零的特征值，故被控对象不稳定3.2确定希望的极点希望的极点n=4，选其中一对为主导极点和，另一对为远极点，认为系统性能主要由主导极点决定，远极点只有微小影响。根据二阶系统的关系式，先确定主导极点可得，于是取；取误差带，则，闭环主导极点为=-10.8j,远极点选择使它和原点的距离大于主导极点与原点距离的5倍，取3.3采用状态反馈方法使系统稳定并配置极点状态反馈的控制规律为，；状态反馈

2、系统的状态方程为，其特征多项式为 希望特征多项式为 比较以上两式系数，解得状态反馈矩阵4.设计全维观测器4.1判断系统的能观性，rank（）=4,故被控对象完全可观4.2确定观测器的反馈增益全维观测器的动态方程为；其特征多项式为 取观测器的希望极点为：-45，-45，-3+3j，-3-3j；则希望特征多项式为 比较以上两式系数，解得观测器反馈矩阵5.降维状态观测器的设计5.1建立倒置摆三维子系统动态方程设小车位移z由输出传感器测量，因而无需估计，可以设计降维（三维）状态观测器，通过重新排列被控系统变量的次序，把需由降维状态观测器估计的状态变量与输出传感器测得的状态变量分离开。将z作为第四个状态

3、变量，则被控系统的状态方程和输出方程变换为 简记为：式中，=0，被控系统的n-q维子系统动态方程的一般形式为，式中,为子系统输出量。故倒置摆三维子系统动态方程为5.2.判断子系统的可观测性A1=0 -1 0;0 0 1;0 11 0;C1= 1 0 0;Qg1=obsv（A1,C1）;r=rank（Qg1）运行Matlab程序；结果为r=3,故该子系统可观测降维状态观测器动态方程的一般形式为式中h=。考虑被控对象参数，单倒置摆降维观测器动态方程的一般形式为5.3确定三维状态观测器的反馈矩阵h三维状态观测器的特征多项式为设希望的观测器闭环极点为-45，-3+3j，-3-3j，则希望特征多项式为比

4、较以上两式系数，解得h=故所求三维状态观测器的动态方程为6.Matlab仿真分析6.1源程序通过Matlab对用全维状态观测器实现状态反馈的倒置摆系统进行仿真分析，下面是文件名为Inversion_pendulum_system.m的源程序%倒立摆系统建模分析%a）判断系统能控性和能观性clear all;clcA=0 1 0 0;0 0 -1 0;0 0 0 1;0 0 11 0;B=0;1;0;-1;C=1 0 0 0;D=0;Uc=ctrb（A,B）;rc=rank（Uc）;n=size（A）;if rc=n disp（The system is controlled.）elseif r

5、c0）=0）The system is unstable and the ubstable poles are: v（find（Re0）elseThe system is stable!）;% c）极点配置与控制器-全维状态观测器设计与仿真pc=-1+0.8*j,-1-0.8*j,-15,-15;po=-45 -45 -3+3*j -3-3*j;K=acker（A,B,pc）,G=acker（A,C,po）Gp=ss（A,B,C,D）; %将受控过程创建为一个LTI对象disp（受控对象的传递函数模型：H=tf（Gp）Af=A-B*K-G*C;观测器控制器模型：Gc=ss（Af,-G,-K,0

6、） %将观测器-控制器创建为一个LTI对象观测器控制器的极点：f_poles=pole（Gc）GpGc=Gp*Gc; %控制器和对象串联观测器控制器与对象串联构成的闭环系统模型：Gcl=feedback（GpGc,1,-1） %闭环系统闭环系统的极点和零点：c_poles=pole（Gcl）c_zeros=tzero（Gcl）lfg=dcgain（Gcl） %低频增益N=1/lfg % 归一化常数T=N*Gcl; %将N与闭环系统传递函数串联x0=100 10 30 10 0 0 0 0;%初始条件向量t=0:0.01:1; %时间列向量r=0*t; %零参考输入y t x=lsim（T,r,

7、t,x0）; %初始条件仿真plot（t,x（:,1:4）,-.,t,x（:,5:8） %由初始条件引起的状态响应title（bf状态响应legend（x1,x2x3x4x1hatx2hatx3hatx4hatfigure（2）step（T）bf阶跃响应figure（3）impulse（T）bf脉冲响应 6.2 程序运行结果The system is controlled.The system is observable.P = 1 0 -11 0 0v = 0 3.3166 -3.3166ans =K = -36.9000 -49.9200 -334.5400 -81.9200G = 96

8、2594 -14826 -64984受控对象的传递函数模型 Transfer function:s2 - 1.776e-015 s - 10- s4 - 11 s2a = x1 x2 x3 x4 x1 -96 1 0 0 x2 -2557 49.92 333.5 81.92 x3 1.483e+004 0 0 1 x4 6.495e+004 -49.92 -323.5 -81.92b = u1 x1 -96 x2 -2594 x3 1.483e+004 x4 6.498e+004c = y1 36.9 49.92 334.5 81.92d = y1 0Continuous-time model

9、.f_poles = 1.0e+002 * -1.4948 + 1.8786i -1.4948 - 1.8786i 1.7424 -0.0328 a = x1 x2 x3 x4 x5 x1 0 1 0 0 0 x2 0 0 -1 0 36.9 x3 0 0 0 1 0 x4 0 0 11 0 -36.9 x5 96 0 0 0 -96 x6 2594 0 0 0 -2557 x7 -1.483e+004 0 0 0 1.483e+004 x8 -6.498e+004 0 0 0 6.495e+004 x6 x7 x8 x1 0 0 0 x2 49.92 334.5 81.92 x3 0 0 0

10、 x4 -49.92 -334.5 -81.92 x5 1 0 0 x6 49.92 333.5 81.92 x7 0 0 1 x8 -49.92 -323.5 -81.92 b = x1 0 x2 0 x3 0 x4 0 x5 -96 x6 -2594 x7 1.483e+004 x8 6.498e+004 c = x1 x2 x3 x4 x5 x6 x7 x8 y1 1 0 0 0 0 0 0 0 d = Continuous-time model.c_poles = -45.0000 -15.0001 -14.9999 -3.0000 + 3.0000i -3.0000 - 3.0000i -1.0000 + 0.8000i -1.0000 - 0.8000ic_zeros = 3.1623 0.2263 -0.1707 -3.4312 -3.1623lfg = 1.0000N =1.0000由控制器全维状态观测器实现的倒立摆系统在初始条件下引起的状态变量的响应、输出变量的阶跃响应和脉冲响应如下图图（2）状态响应（虚线）和（实线）图（3）阶跃响应图（4）脉冲响应