facat
/
ncp_sigmoid
1
0
Fork 0
Code Issues Pull Requests Releases Wiki Activity
ncp_sigmoid/NCP函数法/formHSB.m

201 lines
10 KiB
Mathematica
Raw Permalink Normal View History

备份 Signed-off-by: dmy@lab <dmy@lab.lab>
2015-01-29 21:32:27 +08:00
function [HSB,dhx,dgx,dgxT,N1,H1,diagE,diagF,GIJ,BIJ,L1,U1,LZ,UW]=formHSB(nodeNum,balNode,balNum,opfGoal,lineNum,transNum,lineI,lineJ,...
transI,transJ,T,transG,transB,pgNode,pvNode,G,B,e,f,pgNum,pvNum,pgvNum,xNum,capNum,capI,a,m,r,l,u,z,w,y,H1,N1,diagE,diagF)
%<EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>ܣ<EFBFBD>Ԥ<EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>̣<EFBFBD><EFBFBD>γ<EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>ϵ<EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>
%<EFBFBD><EFBFBD>дʱ<EFBFBD>䣺2010<EFBFBD><EFBFBD>11<EFBFBD><EFBFBD>
%% <EFBFBD>γɵ<EFBFBD>ʽԼ<EFBFBD><EFBFBD><EFBFBD>ſɱȾ<EFBFBD><EFBFBD><EFBFBD>
ef1=e(transI).*e(transJ)+f(transI).*f(transJ);
ef2=e(transI).*f(transJ)-e(transJ).*f(transI);
ef3=e(transI).*e(transI)+f(transI).*f(transI);
ef1G=ef1.*transG;
ef1B=ef1.*transB;
ef2G=ef2.*transG;
ef2B=ef2.*transB;
dhPTi=-ef1G+ef2B+2*ef3.*transG.*T;
dhPTj=-ef1G-ef2B;
dhPT=sparse(1:transNum,transI,dhPTi,transNum,nodeNum)+sparse(1:transNum,transJ,dhPTj,transNum,nodeNum);%<EFBFBD>й<EFBFBD>ƽ<EFBFBD>ⷽ<EFBFBD><EFBFBD>P<EFBFBD>Ա<EFBFBD>ѹ<EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>ƫ<EFBFBD><EFBFBD>
dhQTi=ef1B+ef2G-2*ef3.*transB.*T;
dhQTj=ef1B-ef2G;
dhQT=sparse(1:transNum,transI,dhQTi,transNum,nodeNum)+sparse(1:transNum,transJ,dhQTj,transNum,nodeNum);%<EFBFBD>޹<EFBFBD>ƽ<EFBFBD>ⷽ<EFBFBD><EFBFBD>Q<EFBFBD>Ա<EFBFBD>ѹ<EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>ƫ<EFBFBD><EFBFBD>
dhP=sparse(1:pgNum,pgNode,ones(pgNum,1),pgNum,m);
dhQ1=sparse(1:pvNum,pvNode,ones(pvNum,1),pvNum,nodeNum);
dhQ=[sparse(pvNum,nodeNum) dhQ1];
dhcapK1=sparse(1:capNum,capI,(e(capI).^2+f(capI).^2),capNum,nodeNum); %<EFBFBD><EFBFBD><EFBFBD><EFBFBD>ƽ<EFBFBD>ⷽ<EFBFBD>̶Ե<EFBFBD><EFBFBD>ݵ翹<EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>ƫ<EFBFBD><EFBFBD>
dhcapK=[sparse(capNum,nodeNum) dhcapK1];
%<EFBFBD><EFBFBD><EFBFBD>ʷ<EFBFBD><EFBFBD><EFBFBD><EFBFBD>ſɱȾ<EFBFBD><EFBFBD><EFBFBD>
deG=diagE*G;
dfB=diagF*B;
deB=diagE*B;
dfG=diagF*G;
dH1=sparse(1:nodeNum,1:nodeNum,H1,nodeNum,nodeNum);
dN1=sparse(1:nodeNum,1:nodeNum,N1,nodeNum,nodeNum);
Hij=-dH1-deG-dfB;
Nij=-dN1+deB-dfG;
Jij=dN1-dfG+deB;
Lij=-dH1+dfB+deG;
%<EFBFBD>ϲ<EFBFBD><EFBFBD>γɹ<EFBFBD><EFBFBD>ʷ<EFBFBD><EFBFBD><EFBFBD><EFBFBD>ſɱȾ<EFBFBD><EFBFBD><EFBFBD>
dhJacb=[Hij Nij;Jij Lij]';
%<EFBFBD>ϲ<EFBFBD><EFBFBD>γɵ<EFBFBD>ʽԼ<EFBFBD><EFBFBD><EFBFBD>ſɱȾ<EFBFBD><EFBFBD><EFBFBD>h(x)
dhx=[dhPT dhQT;dhP;dhQ;dhcapK;dhJacb];
%% <EFBFBD>γɲ<EFBFBD><EFBFBD><EFBFBD>ʽԼ<EFBFBD><EFBFBD><EFBFBD>ſɱȾ<EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>g(x)
dgT1=sparse(1:transNum,1:transNum,ones(transNum,1),transNum,r-lineNum);
dglT=(e(transI).^2+f(transI).^2-e(transI).*e(transJ)-f(transI).*f(transJ)).*transG+(e(transI).*f(transJ)-e(transJ).*f(transI)).*transB;
dgT2=sparse(1:transNum,lineNum-transNum+1:lineNum,dglT,transNum,lineNum);
dgT=[dgT1 dgT2]; %<EFBFBD><EFBFBD><EFBFBD>в<EFBFBD><EFBFBD><EFBFBD>ʽ<EFBFBD>Ա<EFBFBD><EFBFBD><EFBFBD><EFBFBD>󵼵<EFBFBD>ģ<EFBFBD><EFBFBD>
dgP=sparse(1:pgNum,transNum+1:transNum+pgNum,ones(pgNum,1),pgNum,r); %<EFBFBD><EFBFBD><EFBFBD>в<EFBFBD><EFBFBD><EFBFBD>ʽԼ<EFBFBD><EFBFBD><EFBFBD><EFBFBD>PG<EFBFBD>󵼵<EFBFBD>ģ<EFBFBD><EFBFBD>
dgQ=sparse(1:pvNum,transNum+pgNum+1:transNum+pgvNum,ones(pvNum,1),pvNum,r); %<EFBFBD><EFBFBD><EFBFBD>в<EFBFBD><EFBFBD><EFBFBD>ʽԼ<EFBFBD><EFBFBD><EFBFBD><EFBFBD>QR<EFBFBD>󵼵<EFBFBD>ģ<EFBFBD><EFBFBD>
dgcapK=sparse(1:capNum,transNum+pgvNum+1:transNum+pgvNum+capNum,ones(capNum,1),capNum,r);%<EFBFBD><EFBFBD><EFBFBD>в<EFBFBD><EFBFBD><EFBFBD>ʽԼ<EFBFBD><EFBFBD><EFBFBD><EFBFBD>capK<EFBFBD>󵼵<EFBFBD>ģ<EFBFBD><EFBFBD>
dgve=2*diagE;
dgvf=2*diagF;
sizeG=size(G);
GIJ=G(sub2ind(sizeG,lineI,lineJ));
BIJ=B(sub2ind(sizeG,lineI,lineJ));
dgleI=(2*e(lineI)-e(lineJ)).*GIJ+f(lineJ).*BIJ;
dgleJ=-e(lineI).*GIJ-f(lineI).*BIJ;
dglfI=(2*f(lineI)-f(lineJ)).*GIJ-e(lineJ).*BIJ;
dglfJ=-f(lineI).*GIJ+e(lineI).*BIJ;
dgle=sparse(lineI,(1:lineNum),dgleI,nodeNum,lineNum)+sparse(lineJ,(1:lineNum),dgleJ,nodeNum,lineNum);
dglf=sparse(lineI,(1:lineNum),dglfI,nodeNum,lineNum)+sparse(lineJ,(1:lineNum),dglfJ,nodeNum,lineNum);
dg0=sparse(m,transNum+pgvNum+capNum);
dgvl=[dgve dgle;dgvf dglf];
dgef=[dg0 dgvl]; %<EFBFBD><EFBFBD><EFBFBD>в<EFBFBD><EFBFBD><EFBFBD>ʽԼ<EFBFBD><EFBFBD><EFBFBD>Ե<EFBFBD>ѹʵ<EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>鲿<EFBFBD><EFBFBD>ƫ<EFBFBD><EFBFBD><EFBFBD><EFBFBD>ģ<EFBFBD><EFBFBD>
dgx=[dgT;dgP;dgQ;dgcapK;dgef]; %<EFBFBD><EFBFBD><EFBFBD><EFBFBD>ʽԼ<EFBFBD><EFBFBD><EFBFBD>ſ˱Ⱦ<EFBFBD><EFBFBD><EFBFBD>
%% <EFBFBD>γɶԽ<EFBFBD><EFBFBD><EFBFBD>
Z=sparse(1:r,1:r,z,r,r);
W=sparse(1:r,1:r,w,r,r);
L1=sparse(1:r,1:r,1./l,r,r);
U1=sparse(1:r,1:r,1./u,r,r);
LZ=L1*Z;
UW=U1*W;
%% <EFBFBD>γɺ<EFBFBD>ɭ<EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>
%Ŀ<EFBFBD>꺯<EFBFBD><EFBFBD><EFBFBD>ĺ<EFBFBD>ɭ<EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>2f(x)
if(opfGoal==2)
HSdfx=sparse(xNum,xNum);
else if(opfGoal==1)
HSdfx=sparse(transNum+1:transNum+pgNum,transNum+1:transNum+pgNum,2*a(pgNode),xNum,xNum);%<EFBFBD><EFBFBD>Ŀ<EFBFBD>꺯<EFBFBD><EFBFBD><EFBFBD><EFBFBD>PG<EFBFBD><EFBFBD>ƫ<EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>ĶԽ<EFBFBD>ԪΪ<EFBFBD><EFBFBD><EFBFBD><EFBFBD>Ԫ<EFBFBD>أ<EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>Ϊ0
else if(opfGoal==3)
d2ftei=-2*transG.*(e(transI)-e(transJ));
d2ftej=-d2ftei;
d2ftfi=-2*transG.*(f(transI)-f(transJ));
d2ftfj=-d2ftfi;
d2fte=sparse(1:transNum,transI,d2ftei,transNum,nodeNum)+sparse(1:transNum,transJ,d2ftej,transNum,nodeNum);
d2ftf=sparse(1:transNum,transI,d2ftfi,transNum,nodeNum)+sparse(1:transNum,transJ,d2ftfj,transNum,nodeNum);
d2fT0=sparse(transNum,transNum+pgvNum+capNum);
d2fT=[d2fT0 d2fte d2ftf];
d2fPGQR=sparse(pgvNum,xNum);
d2fcapK=sparse(capNum,xNum);
d2fee=2*(G-sparse(1:nodeNum,1:nodeNum,sum(G,2),nodeNum,nodeNum));
d2fff=d2fee;
zero_nodeNum=sparse(nodeNum,nodeNum);
d2f_ef_ef=[d2fee zero_nodeNum;zero_nodeNum d2fff];
d2efT=[d2fte d2ftf]';
d2f_ef=[d2efT sparse(2*nodeNum,pgvNum+capNum) d2f_ef_ef];
HSdfx=[d2fT;d2fPGQR;d2fcapK;d2f_ef];
else if(opfGoal==4)
d2ftei=2*transB.*(e(transI)-e(transJ));
d2ftej=-d2ftei;
d2ftfi=2*transB.*(f(transI)-f(transJ));
d2ftfj=-d2ftfi;
d2fte=sparse(1:transNum,transI,d2ftei,transNum,nodeNum)+sparse(1:transNum,transJ,d2ftej,transNum,nodeNum);
d2ftf=sparse(1:transNum,transI,d2ftfi,transNum,nodeNum)+sparse(1:transNum,transJ,d2ftfj,transNum,nodeNum);
d2fT0=sparse(transNum,transNum+pgvNum+capNum);
d2fT=[d2fT0 d2fte d2ftf];
d2fPGQR=sparse(pgvNum,xNum);
d2fcapK=sparse(capNum,xNum);
d2fee=-2*(B-sparse(1:nodeNum,1:nodeNum,sum(B,2),nodeNum,nodeNum));
d2fff=d2fee;
zero_nodeNum=sparse(nodeNum,nodeNum);
d2f_ef_ef=[d2fee zero_nodeNum;zero_nodeNum d2fff];
d2efT=[d2fte d2ftf]';
d2f_ef=[d2efT sparse(2*nodeNum,pgvNum+capNum) d2f_ef_ef];
HSdfx=[d2fT;d2fPGQR;d2fcapK;d2f_ef];
end
end
end
end
%<EFBFBD><EFBFBD>ʽԼ<EFBFBD><EFBFBD><EFBFBD><EFBFBD>ɭ<EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>ճ<EFBFBD><EFBFBD><EFBFBD>y<EFBFBD>ij˻<EFBFBD><EFBFBD><EFBFBD>2h(x)*y
y1=y(1:nodeNum,1);
y2=y(nodeNum+1:2*nodeNum,1);
dhT2=2*ef3.*(transG.*y1(transI)-transB.*y2(transI)); %<EFBFBD><EFBFBD><EFBFBD>ʷ<EFBFBD><EFBFBD>̶Ա<EFBFBD>ѹ<EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>ƫ<EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>õ<EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>
HSdhT=sparse(1:transNum,1:transNum,dhT2,transNum+pgvNum+capNum,transNum+pgvNum+capNum);
eiG=e(transI).*transG;
ejG=e(transJ).*transG;
eiB=e(transI).*transB;
ejB=e(transJ).*transB;
fiG=f(transI).*transG;
fjG=f(transJ).*transG;
fiB=f(transI).*transB;
fjB=f(transJ).*transB;
ejG_fjB=ejG-fjB;
ejGfjB=ejG+fjB;
fjGejB=fjG+ejB;
ejB_fjG=ejB-fjG;
eiGfiB=eiG+fiB;
eiG_fiB=eiG-fiB;
eiB_fiG=eiB-fiG;
fiGeiB=fiG+eiB;
dP2_ei_t=(4*eiG.*T-ejG_fjB).*y1(transI)-ejGfjB.*y1(transJ);
dP2_ej_t=-eiGfiB.*y1(transI)-eiG_fiB.*y1(transJ);
dQ2_ei_t=(-4*eiB.*T+fjGejB).*y2(transI)+ejB_fjG.*y2(transJ);
dQ2_ej_t=eiB_fiG.*y2(transI)+fiGeiB.*y2(transJ);
HSdh_et=sparse(1:transNum,transI,dP2_ei_t+dQ2_ei_t,transNum,nodeNum)+sparse(1:transNum,transJ,dP2_ej_t+dQ2_ej_t,transNum,nodeNum);%<EFBFBD><EFBFBD><EFBFBD>ʷ<EFBFBD><EFBFBD><EFBFBD><EFBFBD>ȶԱ<EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>ƫ<EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>ٶԵ<EFBFBD>ѹʵ<EFBFBD><EFBFBD><EFBFBD><EFBFBD>ƫ<EFBFBD><EFBFBD>ģ<EFBFBD><EFBFBD>
dP2_fi_t=(4*fiG.*T-fjGejB).*y1(transI)+ejB_fjG.*y1(transJ);
dP2_fj_t=eiB_fiG.*y1(transI)-fiGeiB.*y1(transJ);
dQ2_fi_t=(-4*fiB.*T-ejG_fjB).*y2(transI)+ejGfjB.*y2(transJ);
dQ2_fj_t=eiGfiB.*y2(transI)-eiG_fiB.*y2(transJ);
HSdh_ft=sparse(1:transNum,transI,dP2_fi_t+dQ2_fi_t,transNum,nodeNum)+sparse(1:transNum,transJ,dP2_fj_t+dQ2_fj_t,transNum,nodeNum);%<EFBFBD><EFBFBD><EFBFBD>ʷ<EFBFBD><EFBFBD><EFBFBD><EFBFBD>ȶԱ<EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>ƫ<EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>ٶԵ<EFBFBD>ѹ<EFBFBD>鲿<EFBFBD><EFBFBD>ƫ<EFBFBD><EFBFBD>ģ<EFBFBD><EFBFBD>
HSdh_eft=[HSdh_et HSdh_ft];
HSdh_tef=HSdh_eft';
HSdhPQ=sparse(pgvNum,2*nodeNum); %<EFBFBD><EFBFBD><EFBFBD>ʷ<EFBFBD><EFBFBD><EFBFBD><EFBFBD>ȶ<EFBFBD>PG<EFBFBD><EFBFBD>QR<EFBFBD><EFBFBD>ƫ<EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>ٶ<EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>ƫ<EFBFBD><EFBFBD><EFBFBD>IJ<EFBFBD><EFBFBD><EFBFBD>
d2hcap_e=sparse(1:capNum,capI,2*e(capI).*y2(capI),capNum,nodeNum); %<EFBFBD><EFBFBD><EFBFBD>ʷ<EFBFBD><EFBFBD><EFBFBD><EFBFBD>ȶ<EFBFBD>capK<EFBFBD><EFBFBD>ƫ<EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>ٶ<EFBFBD>e<EFBFBD><EFBFBD>ƫ<EFBFBD><EFBFBD><EFBFBD>IJ<EFBFBD><EFBFBD><EFBFBD>
d2hcap_f=sparse(1:capNum,capI,2*f(capI).*y2(capI),capNum,nodeNum); %<EFBFBD><EFBFBD><EFBFBD>ʷ<EFBFBD><EFBFBD><EFBFBD><EFBFBD>ȶ<EFBFBD>capK<EFBFBD><EFBFBD>ƫ<EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>ٶ<EFBFBD>f<EFBFBD><EFBFBD>ƫ<EFBFBD><EFBFBD><EFBFBD>IJ<EFBFBD><EFBFBD><EFBFBD>
HSdhcap_ef=[d2hcap_e d2hcap_f];
d2htPQ_ef=[HSdh_eft;HSdhPQ;HSdhcap_ef];
HSdhtPQ=[HSdhT d2htPQ_ef];
HSdhx1=sparse(m,pgvNum);
%<EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>̺<EFBFBD>ɭ<EFBFBD><EFBFBD><EFBFBD><EFBFBD>
diagy1=sparse(1:nodeNum,1:nodeNum,y1,nodeNum,nodeNum);
diagy2=sparse(1:nodeNum,1:nodeNum,y2,nodeNum,nodeNum);
HSdhey=-diagy1*G+diagy2*B+(-G*diagy1+B*diagy2);
HSdhefy=diagy1*B+diagy2*G-(B*diagy1+G*diagy2);
HSdhx2=[HSdhey HSdhefy;HSdhefy' HSdhey];
HSdhx=[HSdhtPQ;HSdh_tef HSdhx1 HSdhcap_ef' HSdhx2];
%<EFBFBD>γɲ<EFBFBD><EFBFBD><EFBFBD>ʽԼ<EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>ƫ<EFBFBD><EFBFBD><EFBFBD>ľ<EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>2g(x)*(z+w)
ZWcl=z(transNum+pgvNum+capNum+nodeNum+1:end)+w(transNum+pgvNum+capNum+nodeNum+1:end);
ZWv=z(transNum+pgvNum+capNum+1:transNum+pgvNum+capNum+nodeNum)+w(transNum+pgvNum+capNum+1:transNum+pgvNum+capNum+nodeNum);
dgeiT=((2*e(transI)-e(transJ)).*transG+f(transJ).*transB).*ZWcl(lineNum-transNum+1:end);
dgejT=(-e(transI).*transG-f(transI).*transB).*ZWcl(lineNum-transNum+1:end);
dgeT=sparse(1:transNum,transI,dgeiT,transNum,nodeNum)+sparse(1:transNum,transJ,dgejT,transNum,nodeNum);%<EFBFBD><EFBFBD><EFBFBD><EFBFBD>ʽԼ<EFBFBD><EFBFBD><EFBFBD>ȶԱ<EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>ƫ<EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>ٶ<EFBFBD>e<EFBFBD><EFBFBD>ƫ<EFBFBD><EFBFBD><EFBFBD><EFBFBD>ģ<EFBFBD><EFBFBD>
dgfiT=((2*f(transI)-f(transJ)).*transG-e(transJ).*transB).*ZWcl(lineNum-transNum+1:end);
dgfjT=(-f(transI).*transG+e(transI).*transB).*ZWcl(lineNum-transNum+1:end);
dgfT=sparse(1:transNum,transI,dgfiT,transNum,nodeNum)+sparse(1:transNum,transJ,dgfjT,transNum,nodeNum);%<EFBFBD><EFBFBD><EFBFBD><EFBFBD>ʽԼ<EFBFBD><EFBFBD><EFBFBD>ȶԱ<EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>ƫ<EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>ٶ<EFBFBD>f<EFBFBD><EFBFBD>ƫ<EFBFBD><EFBFBD><EFBFBD><EFBFBD>ģ<EFBFBD><EFBFBD>
HSdgefT=[dgeT dgfT];
HSdgT=[sparse(transNum,transNum+pgvNum+capNum) HSdgefT];
HSdgee=sparse(lineI,lineI,2*GIJ.*ZWcl,nodeNum,nodeNum)-sparse(lineI,lineJ,GIJ.*ZWcl,nodeNum,nodeNum)...
-sparse(lineJ,lineI,GIJ.*ZWcl,nodeNum,nodeNum)+sparse(1:nodeNum,1:nodeNum,2*ZWv,nodeNum,nodeNum);
HSdgff=HSdgee;
HSdgef=sparse(lineI,lineJ,BIJ.*ZWcl,nodeNum,nodeNum)-sparse(lineJ,lineI,BIJ.*ZWcl,nodeNum,nodeNum);
HSdgfe=HSdgef';
HSdgx1=[HSdgee HSdgef;HSdgfe HSdgff]; %<EFBFBD><EFBFBD><EFBFBD>в<EFBFBD><EFBFBD><EFBFBD>ʽԼ<EFBFBD><EFBFBD><EFBFBD><EFBFBD>e<EFBFBD><EFBFBD>f<EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>ƫ<EFBFBD><EFBFBD>ģ<EFBFBD><EFBFBD>
HSdgxtPQ_0=sparse(pgvNum+capNum,xNum);
HSdgef_0=[HSdgefT' sparse(2*nodeNum,pgvNum+capNum)];
HSdgx=[HSdgT;HSdgxtPQ_0;HSdgef_0 HSdgx1]; %<EFBFBD>ϳɲ<EFBFBD><EFBFBD><EFBFBD>ʽԼ<EFBFBD><EFBFBD><EFBFBD><EFBFBD>ɭ<EFBFBD><EFBFBD><EFBFBD><EFBFBD>
%<EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>γ<EFBFBD>H(.)<EFBFBD><EFBFBD><EFBFBD><EFBFBD>.
dgxT=dgx'; %<EFBFBD><EFBFBD>dgx<EFBFBD><EFBFBD>ת<EFBFBD><EFBFBD>
MULdgx=dgx*(UW-LZ)*dgxT;
H=HSdhx+HSdgx-HSdfx+MULdgx; %<EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>γ<EFBFBD>H(.)<EFBFBD><EFBFBD><EFBFBD><EFBFBD>.
%% <EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>ĸ<EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>ϳɺ<EFBFBD>ɭ<EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>
HSB0=sparse(m,m);
HSB=[H dhx;dhx' HSB0];
balN=transNum+pgvNum+capNum+nodeNum+balNode;
HSB(balN,:)=0; %<EFBFBD><EFBFBD><EFBFBD><EFBFBD>ƽ<EFBFBD><EFBFBD><EFBFBD>ڵ<EFBFBD><EFBFBD><EFBFBD>ѹ<EFBFBD>鲿<EFBFBD><EFBFBD><EFBFBD>䣬ʼ<EFBFBD><EFBFBD>Ϊ0<EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>ɭ<EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>ƽ<EFBFBD><EFBFBD><EFBFBD>ڵ<EFBFBD><EFBFBD>鲿<EFBFBD><EFBFBD><EFBFBD><EFBFBD>Ӧ<EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>Ԫ<EFBFBD><EFBFBD><EFBFBD><EFBFBD>0<EFBFBD><EFBFBD><EFBFBD>Խ<EFBFBD>Ԫ<EFBFBD><EFBFBD><EFBFBD><EFBFBD>1
HSB(:,balN)=0;
HSB_balN=sub2ind(size(HSB),balN,balN);
HSB(HSB_balN)=ones(balNum,1);
balN1=transNum+pgvNum+capNum+balNode;
HSB(balN1,:)=0; %<EFBFBD><EFBFBD><EFBFBD><EFBFBD>ƽ<EFBFBD><EFBFBD><EFBFBD>ڵ<EFBFBD><EFBFBD><EFBFBD>ѹʵ<EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>䣬ʼ<EFBFBD><EFBFBD>Ϊ0<EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>ɭ<EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>ƽ<EFBFBD><EFBFBD><EFBFBD>ڵ<EFBFBD>ʵ<EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>Ӧ<EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>Ԫ<EFBFBD><EFBFBD><EFBFBD><EFBFBD>0<EFBFBD><EFBFBD><EFBFBD>Խ<EFBFBD>Ԫ<EFBFBD><EFBFBD><EFBFBD><EFBFBD>1
HSB(:,balN1)=0;
HSB_balN1=sub2ind(size(HSB),balN1,balN1);
HSB(HSB_balN1)=ones(balNum,1);
HSB=sparse(HSB);