24小时热门版块排行榜    

查看: 779  |  回复: 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的回帖
相关版块跳转 我要订阅楼主 民大科研狗 的主题更新
普通表情 高级回复 (可上传附件)
最具人气热帖推荐 [查看全部] 作者 回/看 最后发表
[考博] 【2027博士申请】纳米药物递送方向 20+3 13586093586 2026-08-03 5/250 2026-08-08 21:54 by 13586093586
[公派出国] 售SCI文章,我:8O5.5.1.O.54,科目齐全,可+急 +3 qTvzQBRAHjCi 2026-08-07 4/200 2026-08-08 17:27 by oEVWOejN9taj
[基金申请] 售SCI一区T0P文章,我:8.O.55.1.O54,科目全,可伽急 +3 qTvzQBRAHjCi 2026-08-07 4/200 2026-08-08 17:22 by oEVWOejN9taj
[考研] 售SCI一区T0P文章,我:8.O55.1.O.54,科目全,可十急 +3 qTvzQBRAHjCi 2026-08-07 5/250 2026-08-08 16:47 by oEVWOejN9taj
[论文投稿] 售SCI-T0P文章,我:8O.5.5.1.O.54,科目齐全,可+急 +3 qTvzQBRAHjCi 2026-08-07 4/200 2026-08-08 16:47 by oEVWOejN9taj
[论文投稿] 售SCI一区文章,我:8.O.55.1.O.54,科目齐全,可伽急 +3 Vi50GxzrFcSG 2026-08-07 6/300 2026-08-08 15:07 by oEVWOejN9taj
[论文投稿] 售SCI一区T0P文章,我:8.O.55.1.O.54,科目齐全,可+急 +3 WQyTGMbfH7Cx 2026-08-07 4/200 2026-08-08 15:02 by oEVWOejN9taj
[基金申请] fileCode有新解读? +9 Tide man 2026-08-08 17/850 2026-08-08 14:56 by archvillain
[论文投稿] 售SCI一区T0P文章,我:8O.55.1.O.5.4,科目齐全,可+急 +3 HEQlVqMTIA7d 2026-08-07 5/250 2026-08-08 14:22 by oEVWOejN9taj
[基金申请] 售SCI-T0P文章,我:8O.5.5.1.O.54,科目齐全,可+急 +4 KXLV3nuBVBY7 2026-08-07 5/250 2026-08-08 14:07 by oEVWOejN9taj
[论文投稿] 售SCI文章,我:8O.5.5.1O.54,科目全,可十急 +3 KXLV3nuBVBY7 2026-08-07 6/300 2026-08-08 14:01 by oEVWOejN9taj
[考博] 售SCI一区文章,我:8.O.55.1.O.54,科目齐全,可伽急 +3 HEQlVqMTIA7d 2026-08-07 3/150 2026-08-08 03:47 by 6vVgjDL4CnGu
[基金申请] 基金中了 +14 laoda193707 2026-08-06 14/700 2026-08-08 00:23 by 实验小白ha
[基金申请] 娱乐 +6 Tide man 2026-08-03 6/300 2026-08-07 22:40 by 铁帽子农民
[基金申请] 固定端突然变了,今天 +6 archvillain 2026-08-06 10/500 2026-08-07 16:03 by 医学老男孩
[基金申请] 大家散了吧,后缀研究没有意义,别浪费时间了,过好目前的每一天,不要焦虑 +5 Tide man 2026-08-06 7/350 2026-08-07 13:11 by 医学老男孩
[基金申请] filecode +14 等待解的谜 2026-08-06 19/950 2026-08-07 12:20 by wlwhappy
[基金申请] 8月时间戳变的,举个手。玩一下,释放压力 +9 archvillain 2026-08-04 11/550 2026-08-05 20:06 by wlwhappy
[基金申请] 纯娱乐,不喜欢勿喷 +7 Tide man 2026-08-04 10/500 2026-08-04 15:10 by loufangrui
[基金申请] 什么时候能放榜呀? +3 Jacob678 2026-08-03 3/150 2026-08-03 16:14 by gltch
信息提示
请填处理意见