1、根据牛顿定律建立系统垂直和水平方向的动力学方程,计及u=F,得 (1) (2)保留低阶项,项,忽略微小的高次项,在竖直位置处进行线性化。由(1)(2)得 (3) (4)令,输入为,则状态方程为 (5)代入参数,忽略摩擦得 (6)该状态方程输入是加速度,输出是小车位置和摆杆角度。2、时不变线性连续系统的状态反馈控制与观测器对时不变线性连续系统 以系统状态为反馈变量产生控制这种控制方式称为状态反馈控制,但状态作为系统内部变量,一般很难直接测出,为此引入状态观测器。全维状态观测器的动态方程为若输出矩阵C为满秩时,可设计较简单的降维状态观测器,其最小维数为n-m(n代表状态个数,m代表输出个数)。六、
2、实验内容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 0Uc = ctrb(A,B);rank(Uc)输出:ans = 4系统能控性矩阵满秩,即系统状态完全能控。(2)系统极点配置选取系统主导极点:闭环非主导极点距虚轴的距离为主导极点的5倍以上,则取: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 = -54.4
3、218 -24.4898 93.2739 16.1633(3)极点配置系统仿真根据系统空间表达式,搭建模型。仿真波形如图从仿真结果可以看出,小车最终稳定,小车速度,摆杆角度,角速度最终都稳定在0位置,小车位置超调5%,调整时间2s,基本符合控制要求。2、采用状态观测器的状态反馈系统设计(1)闭环观测器极点配置 判断可观性 输入代码: A = 0 1 0 0;0 0 0 0;0 0 0 1;0 0 29.4 0;B = 0;1;0;3;0 0 1 0;D = 0;sys = ss(A,B,C,D);observe_matrix = obsv(A,C);rank_of_obsv = rank(ob
4、serve_matrix) 输出: rank_of_obsv = 系统完全可观。 输出矩阵C的秩为2,所以降维观测器的最小维数为4-2=2。 设定降维观测器的期望极点观测器特征值的选取一般是状态反馈配置极点2-3倍,所以选取状态观测器为-5,-5。R = 0 1 0 0;0 0 0 1;P = C;R;invP = inv(P);p = -5;-5; 求取等价系统的模型AA = P*A*invPA11 = AA(1:2,1:2);A12 = AA(1:2,3:4);A21 = AA(3:4,1:A22 = AA(3:4,3:BB = P*BB1 = BB(1:2);B2 = BB(3:4);C
5、C = C*invPAA = 0 0 1.0000 0 0 0 0 1.0000 0 0 0 0 0 29.4000 0 0BB = 0 1 3CC = 1 0 0 0 0 1 0 04 求取矩阵Lsyms ssystem_eq = expand(s-p(1)*(s-p(2)syms L_1 L_2 L_3 L_4L = 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求取降维观测
6、器的动态方程 输入代码:AW = (A22 - LL*A12)BU = (B2 - LL*B1)BY = (A21 - LL*A11) + (A22 - LL*A12)*LLCW = invP(1:4)DY = invP(1:2)+invP(1:4)*LLAW = -5 0 0 -5BU =BY = -25.0000 0 0 4.4000CW = 0 0 1 0 0 1DY = 5 0 0 5(2)系统仿真 仿真波形如图与不带观测器的状态反馈波形基本一致,达到预期效果。从仿真结果可以看出,小车最终稳定,小车速度,摆杆角度,角速度最终都稳定在0位置,调整时间2s,符合控制要求。3、实验平台调试不带观测器的状态反馈:带降维观测器的状态反馈:
copyright@ 2008-2023 冰点文库 网站版权所有
经营许可证编号:鄂ICP备19020893号-2