matlab实现滚动时域估计算法（MHE算法）

matlab实现滚动时域估计算法（MHE算法），将估计问题转化为优化问题，基于粒子群算法求解最优解，结合惩罚函数法来处理带约束的优化问题

function G=fitness（x）

G=0;
[A B C T N P0 Q R n m p jjx0]=matrix;

%%调用T时刻的测量输出值:由y（0）y（1）......y（T-1）组成并储存在y矩阵中
y=evalin（‘base‘‘y‘）;

if （T    for k=0:T-1
        S=zeros（k*pk*p）;
        S1=zeros（k*p1）;
        if （k==0）
        G=G+y（m*k+1:m*k+m1）.‘*inv（R）*y（m*k+1:m*k+m1）-2*x（11:n）*C.‘*inv（R）*y（m*k+1:m*k+m1）+x（11:n）*C.‘*inv（R）*C*x（11:n）.‘...
        +x（1n+k*p+1:n+k*p+p）*inv（Q）*x（1n+k*p+1:n+k*p+p）.‘;%+（x（11:n）-jjx0（11:n））*inv（P0）*（x（11:n）-jjx0（11:n））.‘;%适应度函数的具体表达式 
        else
            for t=0:k-1
                S1（1+t*p:t*p+p1:n）=B.‘*（A.‘）^（k-1-t）; %求S1矩阵
                for j=0:k-1
                    S（j*p+1:j*p+pt*p+1:t*p+p）=B.‘*（A.‘）^（k-1-j）*C.‘*inv（R）*C*A^（k-1-t）*B;%求S矩阵
                end
            end
            G=G+

 属性            大小     日期    时间   名称
----------- ---------  ---------- -----  ----
     文件        1415  2016-05-03 15:47  MHE.m
     文件         670  2016-05-03 16:15  MHEdrawing.m
     文件        1597  2016-05-03 16:15  PSO.m
     文件         745  2016-05-03 16:14  QIUY.m
     文件        2576  2016-04-25 12:21  fitness.m
     文件        1113  2016-04-26 09:46  matrix.m
     文件         512  2016-05-03 16:27  Lfitness.m