stateestimation-ipm/run.asv

clear
clc
% yalmip('clear')
addpath('.\Powerflow')
[~, ~, ~, ~,Volt,Vangle,Y,Yangle,r,c,newwordParameter,PG,QG,PD,QD,Balance]=pf('ieee14.dat', '0');
%% <20><><EFBFBD><EFBFBD><EFBFBD><EFBFBD>
% <20><>ѹ <20>ڵ<EFBFBD><DAB5><EFBFBD><EFBFBD><EFBFBD> ֧·<D6A7><C2B7><EFBFBD><EFBFBD> <20>ڵ㹦<DAB5><E3B9A6> ֧·<D6A7><C2B7><EFBFBD><EFBFBD>
%%
%% ״̬<D7B4><CCAC>
% <20><>ѹ <20><><EFBFBD><EFBFBD>
%%
%% <20><>ʼ<EFBFBD><CABC><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>
sigma=1;% <20><>׼<EFBFBD><D7BC>
%% <20><>ѹ
%<25><>ѹ<EFBFBD><D1B9>ֵ
rVolt=Volt; %<25><>ֵ
mVolt=rVolt.*(normrnd(0,sigma,length(Volt),1)+1);%<25><>ѹ<EFBFBD><D1B9><EFBFBD><EFBFBD><EFBFBD><EFBFBD>
rVAngel=Vangle;
%% <20><><EFBFBD><EFBFBD>
%ע<><D7A2><EFBFBD><EFBFBD><EFBFBD><EFBFBD>
cmpY=Y.*exp(1j*sparse(r,c,Yangle,length(Y),length(Y)));%<25><><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>ɾ<EFBFBD><C9BE><EFBFBD>
cmpV=Volt.*exp(1j*Vangle); %<25><><EFBFBD><EFBFBD><EFBFBD><EFBFBD>ѹ
cmpI=cmpY*cmpV;% ע<><D7A2><EFBFBD><EFBFBD><EFBFBD><EFBFBD>
rI=abs(cmpI); %ע<><D7A2><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>Ҫ<EFBFBD><D2AA><EFBFBD>ǵ<EFBFBD><C7B5><EFBFBD><EFBFBD><EFBFBD>ֵ
mI=rI.*(normrnd(0,sigma,length(rI),1)+1);%<25><><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>
%% ֧·<D6A7><C2B7><EFBFBD><EFBFBD>
% ֧·<D6A7><C2B7><EFBFBD><EFBFBD>
lineI=newwordParameter.line.lineI;
lineJ=newwordParameter.line.lineJ;
lineR=newwordParameter.line.lineR;
lineX=newwordParameter.line.lineX;
lineB2=newwordParameter.line;
transI=
cmpBranchI=(cmpV(lineI)-cmpV(lineJ))./(lineR+1j*lineX);%<25><><EFBFBD><EFBFBD>֧·<D6A7><C2B7><EFBFBD><EFBFBD>
rBranchI=abs(cmpBranchI);% ֧·<D6A7><C2B7><EFBFBD><EFBFBD><EFBFBD><EFBFBD>ֵ
mBranchI=rBranchI.*(normrnd(0,sigma,length(rBranchI),1)+1);%֧·<D6A7><C2B7><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>
%% ֧·<D6A7><C2B7><EFBFBD><EFBFBD>
rBranchP=real((cmpV(lineI)-cmpV(lineJ)).*conj(cmpBranchI));
mBranchP=rBranchP.*(normrnd(0,sigma,length(rBranchP),1)+1);%֧·<D6A7><C2B7><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>
rBranchQ=imag((cmpV(lineI)-cmpV(lineJ)).*conj(cmpBranchI));
mBranchQ=rBranchQ.*(normrnd(0,sigma,length(rBranchQ),1)+1);%֧·<D6A7><C2B7><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>
%% ע<>빦<EFBFBD><EBB9A6>
rPD=PD;
PDi=find(PD~=0);
rQD=QD;
QDi=find(QD~=0);
rPG=PG;
PGi=find(PG~=0);
rQG=QG;
QGi=find(QG~=0);
mPD=rPD.*(normrnd(0,sigma,length(rPD),1)+1);
mQD=rQD.*(normrnd(0,sigma,length(rQD),1)+1);
mPG=rPG.*(normrnd(0,sigma,length(rPG),1)+1);
mQG=rQG.*(normrnd(0,sigma,length(rQG),1)+1);
%% <20><><EFBFBD><EFBFBD><EFBFBD>ȼ<EFBFBD><C8BC><EFBFBD>
stateVarCount=2*length(Volt);
measurements=length(mVolt)+length(mBranchI)+length(mBranchP)+length(mBranchQ)+length(mPG)+length(mQG);
fprintf('<27><><EFBFBD><EFBFBD><EFBFBD><EFBFBD> %f\n',measurements/stateVarCount);
%% 0ע<30><D7A2><EFBFBD>ڵ<EFBFBD>
zerosInjectionIndex=1:length(Volt);
zerosInjectionIndex=zerosInjectionIndex( ~(PD~=0|QD~=0|PG~=0|QG~=0) );
%% <20><>ѹ<EFBFBD><D1B9><EFBFBD><EFBFBD><EFBFBD><EFBFBD>
rTransP=TransPower( newwordParameter,cmpY,rVolt,rVAngel );
rTransQ=TransReactivePower( newwordParameter,cmpY,rVolt,rVAngel );
mTransP=rTransP.*(normrnd(0,sigma,length(rTransP),1)+1);
mTransQ=rTransQ.*(normrnd(0,sigma,length(rTransQ),1)+1);
%% <20><><EFBFBD><EFBFBD><EFBFBD><EFBFBD>ע<EFBFBD>빦<EFBFBD><EBB9A6>
% <20><><EFBFBD>ҵ<EFBFBD>ֻ<EFBFBD>з<EFBFBD><D0B7><EFBFBD><EFBFBD><EFBFBD><EFBFBD>Ľڵ<C4BD>
PDQDi=union(PDi,QDi);
onlyPG=setdiff(PGi,PDQDi);
onlyQG=setdiff(QGi,PDQDi);
%% Opti ToolBox
Busnum=length(Volt);
seOpti=SEOpti();
seOpti=seOpti.init(Busnum, mVolt,sigma,newwordParameter,zerosInjectionIndex,cmpY,onlyPG,onlyQG,mPG,mQG,Balance,mBranchI,mBranchP,mBranchQ,mTransP,mTransQ);
opts = optiset('solver','ipopt');
opts.maxiter=85500;
opts.maxtime=3000;
opts.maxfeval=85000;
opts.maxnodes=85000;
opts.tolrfun=1e-4;
opts.tolafun=1e-4;
opts.warnings='all';
opts.display='off';
x0=[ones(Busnum,1);zeros(Busnum,1)];
[~,seOpti]=seOpti.equ(x0);
nlrhs=seOpti.nlrhs();
nle=seOpti.nle();
% Opt = opti('fun',@seOpti.fun,'ndec',length(Volt)*2,'nlmix',@seOpti.equ,nlrhs,nle,'options',opts)
Opt = opti('fun',@seOpti.fun,'ndec',length(Volt)*2,'options',opts)
[x,fval,exitflag,info] = solve(Opt,x0);
info
%% <20><><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>
SEVolt=x(1:length(Volt));
SEVAngel=x(length(Volt)+Balance:2*length(Volt));
fprintf('Ŀ<>꺯<EFBFBD><EABAAF>Ϊ:%f\n',fval);
fprintf('<27><><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>\n');
(abs(rVolt-double(SEVolt)))./(rVolt)
MaxDeviation(rVolt,SEVolt,rVAngel,SEVAngel)
plotAndComparison( rVolt,rVAngel,SEVolt,SEVAngel )