facat/pes2014
1
0
Fork 0
Code Issues Pull Requests Releases Wiki Activity

original.not modified.

Browse Source
This commit is contained in:
facat
2012-05-22 11:33:21 +08:00
commit cb34aec845
83 changed files with 13475 additions and 0 deletions
Download Patch File Download Diff File Expand all files Collapse all files

36
SolveIt.m Normal file
View File

@@ -0,0 +1,36 @@
function XX=SolveIt(deltF,deltG,Init_L,Init_Z,Init_U,Init_W,deltdeltF,ddh,ddg,deltH,Init_Y,Ly,Lz,ContrlCount,Lw,Lul,Luu,RestraintCount,Lx,Balance,PVi,PGi,Busnum)
LxComa=FormLxComa(deltF,deltG,deltH,Init_L,Luu,Lul,Init_Z,Init_Y,Lz,Init_U,Init_W,Lw,Lx);
H=-deltdeltF+ddh;%+ddg*(Init_Z'+Init_W');
t1=diag(Init_L.\Init_Z-Init_U.\Init_W);
t2=-deltG*( t1 )*deltG';
aa=[
(H+t2),deltH;
deltH',zeros(size(Init_Y,2));
];
yy=[LxComa;-Ly];
% t=size(PVi,1)+size(PGi,1);
% aa(t+2*Balance-1,:)=0;
% aa(:,t+2*Balance-1)=0;
% aa(t+2*Balance-1,t+2*Balance-1)=1;
%ÔÝʱ¸ÄÒ»ÏÂ
t=size(PVi,1)+size(PGi,1)+Busnum;
aa(t+Balance,:)=0;
aa(:,t+Balance)=0;
aa(t+Balance,t+Balance)=1;
dxdy=aa\yy;
dX=dxdy(1:ContrlCount);
dY=dxdy(ContrlCount+1:ContrlCount+2*Busnum);
dL=Lz+deltG'*dX;
dU=-Lw-deltG'*dX;
dZ=-diag(Init_L)\Lul-diag(Init_L)\diag(Init_Z)*dL;
dW=-diag(Init_U)\Luu-diag(Init_U)\diag(Init_W)*dU;
XX=[
dX;
dY;
dZ;
dW;
dL;
dU;
];
end