24小时热门版块排行榜    

查看: 769  |  回复: 0

民大科研狗

新虫 (正式写手)

[交流] 麻烦各位帮我看看多输入极点配置求取反馈增益程序出错的原因,谢谢了!

A1=[0 0 0 1 0 0;0 0 0 0 1 0;0 0 0 0 0 1;0 0 0 0 0 0;0 0 0 0 0 0;0 0 0 0 0 0];
A2=[0 0 0;0 0 0;0 0 0;0 0 0;0 0 0;0 0 0];
A3=[-1 0 0 0 0 0;0 -1 0 0 0 0;0 0 -1 0 0 0];
A4=[0 0 0;0 0 0;0 0 0];
A=[A1 A2;A3 A4]
B1=[0 0 0 0;0 0 0 0;0 0 0 0;0.267 0 0.267 0;0 0.267 0 0.267;-1.3104 1.3317 1.3467 -1.3251];
B2=[0 0 0 0;0 0 0 0;0 0 0 0];
B=[B1;B2]
C=[1 0 0 0 0 0;0 1 0 0 0 0;0 0 1 0 0 0];
X=[-1 -1 -2 -4 -5 -1-j -1+j -2-3*j -2+3*j];
%确定B矩阵的无关列向量
for l=1:2
    RA=rank(A);RB=rank(B);Bwg=B(:,l);
    for i=2:RB
        if rank(Bwg)<RB,
            Bwg=[Bwg,B(:,i)];
        end
    end
    %确定能控性指数
    SO=[];
    for i=0:RA
        for j=1:RB
            if
                rank(SO)<rank([SO, A^i*Bwg(:,j)]),
                SO=[SO,A^i*Bwg(:,j)];
                u(j)=i+1;
            end
        end
    end
end
%构造p矩阵
PNI=[];
for j=1:RB
    for i=0:u(j)-1
        PNI=[PNI,A^i*Bwg(:,j)];
    end
end
P=inv(PNI);
%构造变换矩阵S逆
SNI=[];j=0;
for k=1:RB
    j=u(k)+j;
    for i=0:u(k)-1
        SNI=[SNI;P(j,*A^i];
    end
end
%龙伯格规范矩阵Ac,Bc
S=inv(SNI);Ac=SNI*A*S;Bc=SNI*B;
Cc=C*S;
%求期望的极点所确定的多项式系数阵R
R=zeros(RB,max(u)+1);a=1;k=0;
for j=1:RB
    if u(j)<max(u)
        for i=1:u(j)
            a=conv(a,[1,-X(k+i)]);
        end
        R(j,=[zeros(1,max(u)-u(j)),a];
        a=1;k=k+u(j);
    else
        for i=1:u(j)
            a=conv(a,[-X(k+i)]);
        end
        R(j,=a;a=1;k=k+u(j);
    end
end
R=R(1:RB,2:max(u)+1);
%求状态反馈矩阵K
M=zeros(size(A));j=0;i=1;
for k=1:RB
    j=j+u(k);
    M(j,j-u(k)+1:j)=M(j,j-u(k)+1:j)-R(i,max(u)-1)max(u)-u(k)+1));
    i=i+1;
end
for i=1;size(A)-1
    M(i,i+1)=1;
end
n=0;
for j=1:RB
    n=n+u(j);
    M(n,n+1)=0;
end
M=M(1:size(A),l:size(A));
K=B\(S*(Ac-M)*SNI);
               
  麻烦各位帮我看看多输入极点配置求取反馈增益程序出错的原因,谢谢了!
回复此楼

» 本帖附件资源列表

  • 欢迎监督和反馈:小木虫仅提供交流平台,不对该内容负责。
    本内容由用户自主发布,如果其内容涉及到知识产权问题,其责任在于用户本人,如对版权有异议,请联系邮箱:xiaomuchong@tal.com
  • 附件 1 : 反馈增益.docx
  • 2017-04-14 15:51:37, 13.76 K

» 猜你喜欢

已阅   回复此楼   关注TA 给TA发消息 送TA红花 TA的回帖
相关版块跳转 我要订阅楼主 民大科研狗 的主题更新
普通表情 高级回复 (可上传附件)
最具人气热帖推荐 [查看全部] 作者 回/看 最后发表
[基金申请] 售T0P一区SCI文章,我:8O5.51.O.54,科目齐全,可+急 +3 gr4vd950ka 2026-07-18 4/200 2026-07-19 21:10 by mxyes0ckns
[基金申请] 5个%2F,非固定段22个字母 +12 jaasxulu 2026-07-15 13/650 2026-07-19 21:04 by lfy8008
[硕博家园] 售T0P一区SCI文章,我:8O5.51.O.54,科目齐全,可+急 +4 bjm2e4yior 2026-07-18 4/200 2026-07-19 20:50 by mxyes0ckns
[考博] 售T0P一区SCI文章,我:8O5.51.O.54,科目齐全,可+急 +3 ufgqpyvpi6 2026-07-18 4/200 2026-07-19 20:43 by mxyes0ckns
[考研] 售T0P一区SCI文章,我:8O5.51.O.54,科目齐全,可+急 +3 ufgqpyvpi6 2026-07-18 6/300 2026-07-19 20:34 by mxyes0ckns
[论文投稿] 售T0P一区SCI文章,我:8O5.51.O.54,科目齐全,可+急 +4 ufgqpyvpi6 2026-07-18 7/350 2026-07-19 20:30 by mxyes0ckns
[考博] 售T0P一区SCI文章,我:8O5.51.O.54,科目齐全,可+急 +4 ufgqpyvpi6 2026-07-18 5/250 2026-07-19 20:19 by mxyes0ckns
[论文投稿] 售T0P一区SCI文章,我:8O5.51.O.54,科目齐全,可+急 +3 ufgqpyvpi6 2026-07-18 5/250 2026-07-19 20:10 by mxyes0ckns
[基金申请] 面上的水很深 +17 布布和一二 2026-07-18 22/1100 2026-07-19 20:03 by botar
[硕博家园] 售T0P一区SCI文章,我:8O5.51.O.54,科目齐全,可+急 +4 ufgqpyvpi6 2026-07-18 5/250 2026-07-19 20:03 by mxyes0ckns
[基金申请] 小木虫没落了,除了祈祷帖子,几乎看不到有价值的帖子 +15 botar 2026-07-14 16/800 2026-07-19 18:23 by wowsunflower
[基金申请] 国社科通讯评审 +5 潜水冠军123 2026-07-18 6/300 2026-07-19 12:28 by lfy8008
[基金申请] 生命口面上会评结束了吗大家有知道结果吗?现在还没有结果正常不? +6 碧水00 2026-07-16 9/450 2026-07-17 15:21 by jaasxulu
[论文投稿] 跨出版社商投稿 20+5 倪好520 2026-07-13 5/250 2026-07-16 17:24 by 无视军团
[基金申请] 生生命学部会评 +4 wuke100666 2026-07-15 4/200 2026-07-16 00:12 by 啦啦小妮子
[基金申请] H口,面上,时间戳7月7日。 +3 plumage5 2026-07-15 3/150 2026-07-15 21:06 by 6543yes
[基金申请] 会评 +5 无名者登山 2026-07-15 5/250 2026-07-15 18:15 by 杠就是你对
[论文投稿] 农业机械学报投稿周期 +3 G0DLIN 2026-07-14 7/350 2026-07-15 09:26 by xs74101122
[基金申请] 国自然面上D口祈祷 +4 monkeynana 2026-07-14 4/200 2026-07-15 09:14 by 白水煮
[基金申请] 没收到消息,再次陪跑 +3 天空星辰fly 2026-07-14 3/150 2026-07-14 19:14 by 6543yes
信息提示
请填处理意见