一阶倒立摆含观测器地状态反馈控制系统系统综合与设计.doc

word广 西 大 学 实 验 报 告实验内容：一阶倒立摆含观测器的状态反应控制系统综合与设计一、 实验时间：二、 实验地点：三、 实验目的：1、 理解并掌握线性状态反应控制的原理和方法；2、 理解并掌握线性观测器的设计方法；3、 练习控制性能比拟与评估的方法。四、实验设备与软件：1、倒立摆试验台2、MATLAB软件五、实验原理1、被控对象模型与其线性化根据牛顿定律建立系统垂直和水平方向的动力学方程，计与u=F，得 (1) (2)保存低阶项，项，忽略微小的高次项，在竖直位置处进展线性化。由(1)(2)得 (3) (4)令，输入为，如此状态方程为 5代入参数，忽略摩擦得 6该状态方程输入是加速度，输出是小车位置和摆杆角度。2、 时不变线性连续系统的状态反应控制与观测器对时不变线性连续系统以系统状态为反应变量产生控制这种控制方式称为状态反应控制，但状态作为系统部变量，一般很难直接测出，为此引入状态观测器。全维状态观测器的动态方程为假如输出矩阵C为满秩时，可设计较简单的降维状态观测器，其最小维数为n-mn代表状态个数，m代表输出个数。6、 实验容1、 状态反应与极点配置（1） 能控性检查：输入代码：clear;A = 0 1 0 0; 0 0 0 0; 0 0 0 1; 0 0 29.4 0;B = 0 1 0 3'C = 1 0 0 0; 0 1 0 0;D = 0 0'Uc = ctrb(A,B);rank(Uc)输出：ans = 4系统能控性矩阵满秩，即系统状态完全能控。（2） 系统极点配置选取系统主导极点：，闭环非主导极点距虚轴的距离为主导极点的5倍以上，如此取：，输入代码：clear;A = 0 1 0 0; 0 0 0 0; 0 0 0 1; 0 0 29.4 0;B = 0 1 0 3'P = -10-0.0001*j,-10+0.0001*j,-2-2*sqrt(3)*j,-2+2*sqrt(3)*j;K = place(A,B,P)输出：K =（3） 极点配置系统仿真根据系统空间表达式，搭建模型。仿真波形如图从仿真结果可以看出，小车最终稳定，小车速度，摆杆角度，角速度最终都稳定在0位置，小车位置超调5%，调整时间2s，根本符合控制要求。2、 采用状态观测器的状态反应系统设计（1） 闭环观测器极点配置 <1> 判断可观性输入代码：A = 0 1 0 0;0 0 0 0;0 0 0 1;0 0 29.4 0;B = 0;1;0;3;C = 1 0 0 0;0 0 1 0;D = 0;sys = ss(A,B,C,D);observe_matrix = obsv(A,C);rank_of_obsv = rank(observe_matrix)输出：rank_of_obsv = 4系统完全可观。输出矩阵C的秩为2，所以降维观测器的最小维数为4-2=2。<2> 设定降维观测器的期望极点观测器特征值的选取一般是状态反应配置极点2-3倍，所以选取状态观测器为-5，-5。输入代码：R = 0 1 0 0;0 0 0 1;P = C;R;invP = inv(P);p = -5;-5;<3> 求取等价系统的模型输入代码：AA = P*A*invPA11 = AA(1:2,1:2);A12 = AA(1:2,3:4);A21 = AA(3:4,1:2);A22 = AA(3:4,3:4);BB = P*BB1 = BB(1:2);B2 = BB(3:4);CC = C*invP输出：AA = 0 0 1.0000 0 0 0 0 0 0 29.4000 0 0BB = 0 0 1 3CC = 1 0 0 0 0 1 0 0<4> 求取矩阵L输入代码：syms ssystem_eq = expand(s-p(1)*(s-p(2)syms L_1L_2L_3L_4syms sL = L_1 0;0 L_4;eq = collect(det(s*eye(2)-(A22-L*A12),s) 输出：system_eq =s2 + 10*s + 25eq =s2 + (L_1 + L_4)*s + L_1*L_4选取L= LL = 5 0;0 5;<5>求取降维观测器的动态方程 输入代码：AW = (A22 - LL*A12)BU = (B2 - LL*B1)BY = (A21 - LL*A11) + (A22 - LL*A12)*LLCW = invP(1:4,3:4)DY = invP(1:4,1:2)+invP(1:4,3:4)*LL输出：AW = -5 0 0 -5BU = 1 3BY = -25.0000 0CW = 0 0 1 0 0 0 0 1DY = 1 0 5 0 0 1 0 5（2） 系统仿真 仿真波形如图与不带观测器的状态反应波形根本一致，达到预期效果。从仿真结果可以看出，小车最终稳定，小车速度，摆杆角度，角速度最终都稳定在0位置，调整时间<2s，符合控制要求。3、 实验平台调试不带观测器的状态反应：带降维观测器的状态反应：10 / 10