facat
/
stateestimation-ipm
1
0
Fork 0
Code Issues Pull Requests Releases Wiki Activity

删掉了很多调试的代码 

Signed-off-by: dmy <dugg@21cn.com>
This commit is contained in:
dmy 2013-09-26 22:39:42 +08:00
parent 59f7810cab
commit aa3cf9fa21
1 changed files with 20 additions and 182 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

202
run.m
View File

@ -81,7 +81,7 @@ onlyQG=setdiff(QGi,PDQDi);
measureSigma=abs(([rVolt;rBranchP;rBranchQ;rTransP;rTransQ].*sigma));
measureSigma(measureSigma<1e-6)=mean(measureSigma(measureSigma>1e-6));
W=sparse(diag(1./measureSigma.^2)) ;
W=sparse(1:length(W),1:length(W),1,length(W),length(W));
% W=sparse(1:length(W),1:length(W),1,length(W),length(W));
%% 冗余度计算
stateVarCount=2*length(Volt);
measurements=length(mVolt)+length(mBranchI)+length(mBranchP)+length(mBranchQ)+length(mPG)+length(mQG)+length(mTransP)+length(mTransQ);
@ -106,14 +106,17 @@ fprintf('
% load('mTransQ');
%% 自己写的微分代码
% 初始化一些值
SEVolt=sparse(ones(length(mVolt),1));
%SEVolt=sparse(ones(length(mVolt),1));
SEVolt=rVolt;
% SEVolt=rVolt;
% SEVolt(1:2:end)=1.2;
% load('SEVolt');
% load('SEVAngle');
%SEVolt(Balance)=rVolt(Balance);
SEVAngle=-0.1*sparse(ones(length(mVolt),1));
SEVolt(Balance)=rVolt(Balance);
% SEVAngle=-0.1*sparse(ones(length(mVolt),1));
% SEVAngle(Balance)=0;
SEVAngle=rVAngel;
% SEVAngle=rVAngel;
% SEVolt2= load('SEVolt2');
% SEVolt2=SEVolt2.SEVolt;
% SEVAngle2= load('SEVAngle2');
@ -127,8 +130,8 @@ v=2;
ojbFunDecrease=1000;% 目标函数下降
% 以下都是Jacobi矩阵
% while max(abs(g))>1e-5;
while maxD>1e-5
%while max(abs(optimalCondition))>eps
% while maxD>1e-5
while max(abs(optimalCondition))>eps
% 电压
dV_dV=sparse(1:length(mVolt),1:length(mVolt),1,length(mVolt),length(mVolt));%电压量测量的微分
dV_dTyta=sparse(length(mVolt),length(mVolt));
@ -287,16 +290,6 @@ ojbFunDecrease=1000;% Ŀ
.* ( -(cos(SEVAngle(lineI) -SEVAngle(lineJ)).*lineG + sin(SEVAngle(lineI) -SEVAngle(lineJ)).*lineB)), ...
varNum,varNum);%线路有功海森矩阵
d2LPij_dVj2=0;%线路有功海森矩阵
%%
% d2LPij_dVi2=sparse(lineI,lineI, ...
% 2*lineG ,...
% varNum,varNum);%线路有功海森矩阵
% d2LPij_dVidVj=sparse(lineI,lineJ, ...
% 1 ...
% .* ( -(cos(SEVAngle(lineI) -SEVAngle(lineJ)).*lineG + sin(SEVAngle(lineI) -SEVAngle(lineJ)).*lineB)), ...
% varNum,varNum);%线路有功海森矩阵
% d2LPij_dVj2=0;%线路有功海森矩阵
% t1=d2LPij_dVi2+d2LPij_dVidVj+d2LPij_dVidVj';
% 对相角求导
d2LPij_dTi2=sparse(lineI+busNum,lineI+busNum, ...
Whz(length(mVolt)+1:length(mVolt)+length(lineI))...
@ -311,34 +304,6 @@ ojbFunDecrease=1000;% Ŀ
.*SEVolt(lineI).*SEVolt(lineJ).*( cos( SEVAngle(lineI) -SEVAngle(lineJ) ).*lineG + sin( SEVAngle(lineI) -SEVAngle(lineJ) ).*lineB), ...
varNum,varNum);%线路有功海森矩阵
%%
% d2LPij_dTi2=sparse(lineI+busNum,lineI+busNum, ...
% 1 ...
% .*SEVolt(lineI).*SEVolt(lineJ).*( cos( SEVAngle(lineI) -SEVAngle(lineJ) ).*lineG + sin( SEVAngle(lineI) -SEVAngle(lineJ) ).*lineB), ...
% varNum,varNum);%线路有功海森矩阵
% d2LPij_dTidTj=sparse(lineI+busNum,lineJ+busNum, ...
% 1 ...
% .*(-SEVolt(lineI).*SEVolt(lineJ).*( cos( SEVAngle(lineI) -SEVAngle(lineJ) ).*lineG + sin( SEVAngle(lineI) -SEVAngle(lineJ) ).*lineB) ), ...
% varNum,varNum);%线路有功海森矩阵
% d2LPij_dTj2=sparse(lineJ+busNum,lineJ+busNum, ...
% 1 ...
% .*SEVolt(lineI).*SEVolt(lineJ).*( cos( SEVAngle(lineI) -SEVAngle(lineJ) ).*lineG + sin( SEVAngle(lineI) -SEVAngle(lineJ) ).*lineB), ...
% varNum,varNum);%线路有功海森矩阵
% t2=d2LPij_dTi2+d2LPij_dTidTj+d2LPij_dTj2+d2LPij_dTidTj';
%%
% d2LPij_dTi2=sparse(lineI+busNum,lineI+busNum, ...
% 1 ...
% .*SEVolt(lineI).*SEVolt(lineJ).*( cos( SEVAngle(lineI) -SEVAngle(lineJ) ).*lineG + sin( SEVAngle(lineI) -SEVAngle(lineJ) ).*lineB), ...
% varNum,varNum);%线路有功海森矩阵
% d2LPij_dTidTj=sparse(lineI+busNum,lineJ+busNum, ...
% 1 ...
% .*(-SEVolt(lineI).*SEVolt(lineJ).*( cos( SEVAngle(lineI) -SEVAngle(lineJ) ).*lineG + sin( SEVAngle(lineI) -SEVAngle(lineJ) ).*lineB) ), ...
% varNum,varNum);%线路有功海森矩阵
% d2LPij_dTj2=sparse(lineJ+busNum,lineJ+busNum, ...
% 1 ...
% .*SEVolt(lineI).*SEVolt(lineJ).*( cos( SEVAngle(lineI) -SEVAngle(lineJ) ).*lineG + sin( SEVAngle(lineI) -SEVAngle(lineJ) ).*lineB), ...
% varNum,varNum);%线路有功海森矩阵
% t=d2LPij_dTi2+d2LPij_dTidTj+d2LPij_dTidTj'+d2LPij_dTj2;
%%
% 对电压相角求导
d2LPij_dVidTi=sparse(lineI,lineI+busNum, ...
Whz(length(mVolt)+1:length(mVolt)+length(lineI))...
@ -357,24 +322,6 @@ ojbFunDecrease=1000;% Ŀ
.* (-SEVolt(lineI).* (sin(SEVAngle(lineI) -SEVAngle(lineJ)).*lineG - cos(SEVAngle(lineI) -SEVAngle(lineJ)).*lineB) ), ...
varNum,varNum);%线路有功海森矩阵
%%
% d2LPij_dVidTi=sparse(lineI,lineI+busNum, ...
% 1 ...
% .* (SEVolt(lineJ).* (sin(SEVAngle(lineI) -SEVAngle(lineJ)).*lineG - cos(SEVAngle(lineI) -SEVAngle(lineJ)).*lineB) ), ...
% varNum,varNum);%线路有功海森矩阵
% d2LPij_dVidTj=sparse(lineI,lineJ+busNum, ...
% 1 ...
% .* (-SEVolt(lineJ).* (sin(SEVAngle(lineI) -SEVAngle(lineJ)).*lineG - cos(SEVAngle(lineI) -SEVAngle(lineJ)).*lineB) ), ...
% varNum,varNum);%线路有功海森矩阵
% d2LPij_dVjdTi=sparse(lineJ,lineI+busNum, ...
% 1 ...
% .* (SEVolt(lineI).* (sin(SEVAngle(lineI) -SEVAngle(lineJ)).*lineG - cos(SEVAngle(lineI) -SEVAngle(lineJ)).*lineB) ), ...
% varNum,varNum);%线路有功海森矩阵
% d2LPij_dVjdTj=sparse(lineJ,lineJ+busNum, ...
% 1 ...
% .* (-SEVolt(lineI).* (sin(SEVAngle(lineI) -SEVAngle(lineJ)).*lineG - cos(SEVAngle(lineI) -SEVAngle(lineJ)).*lineB) ), ...
% varNum,varNum);%线路有功海森矩阵
% t3=d2LPij_dVidTi+d2LPij_dVidTj+d2LPij_dVjdTi+d2LPij_dVjdTj;
% t=t1+t2+t3+t3';
% 对电压求导
d2LQij_dVi2=sparse(lineI,lineI, ...
-2*(lineB+lineB2).*Whz(length(mVolt)+length(lineI)+1:length(mVolt)+length(lineI)*2),...
@ -384,16 +331,6 @@ ojbFunDecrease=1000;% Ŀ
.*( -(sin(SEVAngle(lineI) -SEVAngle(lineJ)).*lineG - cos(SEVAngle(lineI) -SEVAngle(lineJ)).*lineB)), ...
varNum,varNum);%线路无功海森矩阵
d2LQij_dVj2=0;%线路无功海森矩阵
% d2LQij_dVi2=sparse(lineI,lineI, ...
% -2*(lineB+lineB2),...
% varNum,varNum);%线路无功海森矩阵
% d2LQij_dVidVj=sparse(lineI,lineJ, ...
% 1 ...
% .*( -(sin(SEVAngle(lineI) -SEVAngle(lineJ)).*lineG - cos(SEVAngle(lineI) -SEVAngle(lineJ)).*lineB)), ...
% varNum,varNum);%线路无功海森矩阵
% d2LQij_dVj2=0;%线路无功海森矩阵
% t1=d2LQij_dVi2+d2LQij_dVidVj+d2LQij_dVj2+d2LQij_dVidVj';
% 对相角求导
d2LQij_dTi2=sparse(lineI+busNum,lineI+busNum, ...
Whz(length(mVolt)+length(lineI)+1:length(mVolt)+length(lineI)*2)...
@ -407,20 +344,6 @@ ojbFunDecrease=1000;% Ŀ
Whz(length(mVolt)+length(lineI)+1:length(mVolt)+length(lineI)*2)...
.*SEVolt(lineI).*SEVolt(lineJ).*( sin( SEVAngle(lineI) -SEVAngle(lineJ) ).*lineG - cos( SEVAngle(lineI) -SEVAngle(lineJ) ).*lineB), ...
varNum,varNum);%线路无功海森矩阵
% d2LQij_dTi2=sparse(lineI+busNum,lineI+busNum, ...
% 1 ...
% .*SEVolt(lineI).*SEVolt(lineJ).*( sin( SEVAngle(lineI) -SEVAngle(lineJ) ).*lineG - cos( SEVAngle(lineI) -SEVAngle(lineJ) ).*lineB), ...
% varNum,varNum);%线路无功海森矩阵
% d2LQij_dTidTj=sparse(lineI+busNum,lineJ+busNum, ...
% 1 ...
% .*(-SEVolt(lineI).*SEVolt(lineJ).*( sin( SEVAngle(lineI) -SEVAngle(lineJ) ).*lineG - cos( SEVAngle(lineI) -SEVAngle(lineJ) ).*lineB)), ...
% varNum,varNum);%线路无功海森矩阵
% d2LQij_dTj2=sparse(lineJ+busNum,lineJ+busNum, ...
% 1 ...
% .*SEVolt(lineI).*SEVolt(lineJ).*( sin( SEVAngle(lineI) -SEVAngle(lineJ) ).*lineG - cos( SEVAngle(lineI) -SEVAngle(lineJ) ).*lineB), ...
% varNum,varNum);%线路无功海森矩阵
% t2=d2LQij_dTi2+d2LQij_dTidTj+d2LQij_dTj2+d2LQij_dTidTj';
% 对电压相角求导
d2LQij_dVidTi=sparse(lineI,lineI+busNum, ...
Whz(length(mVolt)+length(lineI)+1:length(mVolt)+length(lineI)*2)...
@ -438,25 +361,6 @@ ojbFunDecrease=1000;% Ŀ
Whz(length(mVolt)+length(lineI)+1:length(mVolt)+length(lineI)*2)...
.* (SEVolt(lineI).* (cos(SEVAngle(lineI) -SEVAngle(lineJ)).*lineG + sin(SEVAngle(lineI) -SEVAngle(lineJ)).*lineB) ), ...
varNum,varNum);%线路有功海森矩阵
% d2LQij_dVidTi=sparse(lineI,lineI+busNum, ...
% 1 ...
% .* (-SEVolt(lineJ).* (cos(SEVAngle(lineI) -SEVAngle(lineJ)).*lineG + sin(SEVAngle(lineI) -SEVAngle(lineJ)).*lineB) ), ...
% varNum,varNum);%线路有功海森矩阵
% d2LQij_dVidTj=sparse(lineI,lineJ+busNum, ...
% 1 ...
% .* (SEVolt(lineJ).* (cos(SEVAngle(lineI) -SEVAngle(lineJ)).*lineG + sin(SEVAngle(lineI) -SEVAngle(lineJ)).*lineB) ), ...
% varNum,varNum);%线路有功海森矩阵
% d2LQij_dVjdTi=sparse(lineJ,lineI+busNum, ...
% 1 ...
% .* (-SEVolt(lineI).* (cos(SEVAngle(lineI) -SEVAngle(lineJ)).*lineG + sin(SEVAngle(lineI) -SEVAngle(lineJ)).*lineB) ), ...
% varNum,varNum);%线路有功海森矩阵
% d2LQij_dVjdTj=sparse(lineJ,lineJ+busNum, ...
% 1 ...
% .* (SEVolt(lineI).* (cos(SEVAngle(lineI) -SEVAngle(lineJ)).*lineG + sin(SEVAngle(lineI) -SEVAngle(lineJ)).*lineB) ), ...
% varNum,varNum);%线路有功海森矩阵
% t3=d2LQij_dVidTi+d2LQij_dVidTj+d2LQij_dVjdTi+d2LQij_dVjdTj;
% t=t1+t2+t3;
%% 变压器二阶导数
% 对电压求导
d2TPij_dVi2=sparse(transI,transI, ...
@ -467,26 +371,6 @@ ojbFunDecrease=1000;% Ŀ
.* ( -(cos(SEVAngle(transI) -SEVAngle(transJ)).*transG + sin(SEVAngle(transI) -SEVAngle(transJ)).*transB)./transK), ...
varNum,varNum);%变压器有功海森矩阵
d2TPij_dVj2=0;%变压器有功海森矩阵
% d2TPij_dVi2=sparse(transI,transI, ...
% 2*transG./transK./transK.*1,...
% varNum,varNum);%变压器有功海森矩阵
% d2TPij_dVidVj=sparse(transI,transJ, ...
% 1 ...
% .* ( -(cos(SEVAngle(transI) -SEVAngle(transJ)).*transG + sin(SEVAngle(transI) -SEVAngle(transJ)).*transB)./transK), ...
% varNum,varNum);%变压器有功海森矩阵
% d2TPij_dVj2=0;%变压器有功海森矩阵
ggg=H(busNum+length(lineI)*2+1:busNum+length(lineI)*2+length(transI),:)'*H(busNum+length(lineI)*2+1:busNum+length(lineI)*2+length(transI),:)+d2TPij_dVi2+d2TPij_dVidVj+d2TPij_dVidVj';
% d2TPij_dVi2=sparse(transI,transI, ...
% 2*transG./transK./transK.*1,...
% varNum,varNum);%变压器有功海森矩阵
% d2TPij_dVidVj=sparse(transI,transJ, ...
% 1 ...
% .* ( -(cos(SEVAngle(transI) -SEVAngle(transJ)).*transG + sin(SEVAngle(transI) -SEVAngle(transJ)).*transB)./transK), ...
% varNum,varNum);%变压器有功海森矩阵
% d2TPij_dVj2=0;%变压器有功海森矩阵
% t1=d2TPij_dVi2+d2TPij_dVidVj+d2TPij_dVidVj';
% 对相角求导
d2TPij_dTi2=sparse(transI+busNum,transI+busNum, ...
Whz(length(mVolt)+2*length(lineI)+1:length(mVolt)+2*length(lineI)+length(transI))...
@ -499,22 +383,7 @@ ojbFunDecrease=1000;% Ŀ
d2TPij_dTj2=sparse(transJ+busNum,transJ+busNum, ...
Whz(length(mVolt)+2*length(lineI)+1:length(mVolt)+2*length(lineI)+length(transI))...
.*SEVolt(transI).*SEVolt(transJ)./transK.*( cos( SEVAngle(transI) -SEVAngle(transJ) ).*transG + sin( SEVAngle(transI) -SEVAngle(transJ) ).*transB), ...
varNum,varNum);%线路有功海森矩阵
% d2TPij_dTi2=sparse(transI+busNum,transI+busNum, ...
% 1 ...
% .*SEVolt(transI).*SEVolt(transJ)./transK.*( cos( SEVAngle(transI) -SEVAngle(transJ) ).*transG + sin( SEVAngle(transI) -SEVAngle(transJ) ).*transB), ...
% varNum,varNum);%线路有功海森矩阵
% d2TPij_dTidTj=sparse(transI+busNum,transJ+busNum, ...
% 1 ...
% .*(-SEVolt(transI).*SEVolt(transJ)./transK.*( cos( SEVAngle(transI) -SEVAngle(transJ) ).*transG + sin( SEVAngle(transI) -SEVAngle(transJ) ).*transB) ), ...
% varNum,varNum);%线路有功海森矩阵
% d2TPij_dTj2=sparse(transJ+busNum,transJ+busNum, ...
% 1 ...
% .*SEVolt(transI).*SEVolt(transJ)./transK.*( cos( SEVAngle(transI) -SEVAngle(transJ) ).*transG + sin( SEVAngle(transI) -SEVAngle(transJ) ).*transB), ...
% varNum,varNum);%线路有功海森矩阵
% t2=d2TPij_dTi2+d2TPij_dTidTj+d2TPij_dTj2+d2TPij_dTidTj';
varNum,varNum);%Ïß·Óй¦º£É­¾ØÕó
% 对电压相角求导
d2TPij_dVidTi=sparse(transI,transI+busNum, ...
Whz(length(mVolt)+length(lineI)*2+1:length(mVolt)+length(lineI)*2+length(transI)) ...
@ -532,26 +401,6 @@ ojbFunDecrease=1000;% Ŀ
Whz(length(mVolt)+length(lineI)*2+1:length(mVolt)+length(lineI)*2+length(transI)) ...
.* (-SEVolt(transI)./transK.* (sin(SEVAngle(transI) -SEVAngle(transJ)).*transG - cos(SEVAngle(transI) -SEVAngle(transJ)).*transB) ), ...
varNum,varNum);%线路有功海森矩阵
% 对电压相角求导
% d2TPij_dVidTi=sparse(transI,transI+busNum, ...
% 1 ...
% .* (SEVolt(transJ)./transK.* (sin(SEVAngle(transI) -SEVAngle(transJ)).*transG - cos(SEVAngle(transI) -SEVAngle(transJ)).*transB) ), ...
% varNum,varNum);%线路有功海森矩阵
% d2TPij_dVidTj=sparse(transI,transJ+busNum, ...
% 1 ...
% .* (-SEVolt(transJ)./transK.* (sin(SEVAngle(transI) -SEVAngle(transJ)).*transG - cos(SEVAngle(transI) -SEVAngle(transJ)).*transB) ), ...
% varNum,varNum);%线路有功海森矩阵
% d2TPij_dVjdTi=sparse(transJ,transI+busNum, ...
% 1 ...
% .* (SEVolt(transI)./transK.* (sin(SEVAngle(transI) -SEVAngle(transJ)).*transG - cos(SEVAngle(transI) -SEVAngle(transJ)).*transB) ), ...
% varNum,varNum);%线路有功海森矩阵
% d2TPij_dVjdTj=sparse(transJ,transJ+busNum, ...
% 1 ...
% .* (-SEVolt(transI)./transK.* (sin(SEVAngle(transI) -SEVAngle(transJ)).*transG - cos(SEVAngle(transI) -SEVAngle(transJ)).*transB) ), ...
% varNum,varNum);%线路有功海森矩阵
% t3=d2TPij_dVidTi+d2TPij_dVidTj+d2TPij_dVjdTi+d2TPij_dVjdTj;
% t=t1+t2+t3+t3';
% 对电压求导
d2TQij_dVi2=sparse(transI,transI, ...
-2*transB./transK./transK.*Whz(length(mVolt)+length(lineI)*2+length(transI)+1:length(mVolt)+length(lineI)*2+length(transI)*2),...
@ -608,23 +457,12 @@ ojbFunDecrease=1000;% Ŀ
+d2TPij_dVidTi+d2TPij_dVidTj+d2TPij_dVjdTi+d2TPij_dVjdTj ...
+d2TQij_dVidTi+d2TQij_dVidTj+d2TQij_dVjdTi+d2TQij_dVjdTj;
hessian3=hessian2';
G=H'*W*H+hessian14+hessian2+hessian3;
%G=H'*W*H;
if Iteration<=-1
G=H'*W*H;
else
G=H'*W*H+hessian14+hessian2+hessian3;
end
g=H'*Whz;
% gg=H(5:7,:)'*Whz(5:7);
% ggg=H(busNum++length(lineI)+1:busNum+length(lineI)*2,:)'*H(busNum++length(lineI)+1:busNum+length(lineI)*2,:)+d2LPij_dVi2+d2LPij_dVidVj+d2LPij_dVidVj'+d2LPij_dVj2 ...
% +d2LPij_dTi2+d2LPij_dTidTj+d2LPij_dTidTj'+d2LPij_dTj2 ...
% +d2LPij_dVidTi+d2LPij_dVidTj+d2LPij_dVjdTi+d2LPij_dVjdTj ...
% +[d2LPij_dVidTi+d2LPij_dVidTj+d2LPij_dVjdTi+d2LPij_dVjdTj]';
% ggg=H(busNum++length(lineI)+1:busNum+length(lineI)*2,:)'*H(busNum++length(lineI)+1:busNum+length(lineI)*2,:)+d2LQij_dVi2+d2LQij_dVidVj+d2LQij_dVidVj'+d2LQij_dVj2 ...
% +d2LQij_dTi2+d2LQij_dTidTj+d2LQij_dTidTj'+d2LQij_dTj2 ...
% +d2LQij_dVidTi+d2LQij_dVidTj+d2LQij_dVjdTi+d2LQij_dVjdTj ...
% +[d2LQij_dVidTi+d2LQij_dVidTj+d2LQij_dVjdTi+d2LQij_dVjdTj]';
%
% ggg=H(busNum+length(lineI)*2+length(transI)+1:busNum+length(lineI)*2+length(transI)*2,:)'*H(busNum+length(lineI)*2+length(transI)+1:busNum+length(lineI)*2+length(transI)*2,:)+d2TQij_dVi2+d2TQij_dVidVj+d2TQij_dVidVj'+d2TQij_dVj2 ...
% +d2TQij_dTi2+d2TQij_dTidTj+d2TQij_dTidTj'+d2TQij_dTj2 ...
% +d2TQij_dVidTi+d2TQij_dVidTj+d2TQij_dVjdTi+d2TQij_dVjdTj ...
% +[d2TQij_dVidTi+d2TQij_dVidTj+d2TQij_dVjdTi+d2TQij_dVjdTj]';
% hVolt=H(1:busNum,:)'*H(1:busNum,:);
a=G;
@ -635,11 +473,11 @@ ojbFunDecrease=1000;% Ŀ
a=a+sparse(length(mVolt)+Balance,length(mVolt)+Balance,1,size(a,1),size(a,1));
b(length(mVolt)+Balance)=0;
% 平衡节点电压恒定;
% a(Balance,:)=0;
% a(:,Balance)=0;
% a=a+sparse(Balance,Balance,1,size(a,1),size(a,1));
% b(Balance)=0;
dX=inv(a)*b;
a(Balance,:)=0;
a(:,Balance)=0;
a=a+sparse(Balance,Balance,1,size(a,1),size(a,1));
b(Balance)=0;
dX=a\b;
dXStep=1;
% dXStep=Armijo(z,newwordParameter,W,SEVolt,SEVAngle,dX,g );
maxD=max(abs(dX(1:length(mVolt))))