pseudiag.m

控制系统计算机辅助设计——MATLAB语言与应用(源代码）

function Kp=psuediag(G1,R)
A=real(G1); B=imag(G1); [n,m]=size(G1); N=n/m; Kp=[];
if nargin==1, R=ones(N,1); end
for q=1:m
   for i=1:m, for l=1:m
       a=0; ll=[1:q-1, q+1:m];
       for r=1:N
           k=(r-1)*m;
           a=a+R(r)*sum(A(k+i,ll).*A(k+l,ll)+B(k+i,ll).*B(k+l,ll));
       end, 
       Ap(i,l)=a;
   end, end
   [x,d]=eig(Ap); [xm,ii]=min(diag(d)); Kp=[Kp; x(:, ii)'];
end