%n=input('節(jié)點(diǎn)數(shù):n=');
%nzl=input('支路數(shù):nzl=');
%isb=input('平衡節(jié)點(diǎn)號(hào):isb=');
%jd=input('精度:jd=');
%B1=input('支路參數(shù)矩陣:B1=');
%B2=input('節(jié)點(diǎn)參數(shù)矩陣:B2=');
%X=input('節(jié)點(diǎn)號(hào)及其對(duì)地阻抗矩陣:X=');
n=4;
nzl=4;
jd=0.00001;
isb=4;
B1=[ 1  2  0.1+j*0.4   j*0.03056    1        0;
     1  3  j*0.3       0          0.9090909  1;
     1  4  0.12+j*0.5  j*0.0384     1        0;
     2  4  0.08+j*0.4  j*0.02826    1        0; ];
B2=[ 0    0.3+j*0.18   1    0    0   2;
     0    0.55+j*0.13  1    0    0   2;
     0.5    0          1.1   1.1  0  3;
     0      0          1.05 1.05 0   1; ];
X=[1 0;2 0;3 0;4 0];
Y=zeros(n);e=zeros(1,n);f=zeros(1,n);V=zeros(1,n);O=zeros(1,n);S=zeros(1,nzl);J=zeros(2*(n-1));K=zeros(2*(n-1),1);
for i=1:n
    if X(i,2)~=0;
        p=X(i,1);
        Y(p,p)=1./X(i,2);
    end
end    
for i=1:nzl
    if B1(i,6)==0 
        p=B1(i,1);q=B1(i,2);
    else 
        p=B1(i,2);q=B1(i,1);
    end
   Y(p,q)=Y(p,q)-1./(B1(i,3)*B1(i,5));
   Y(q,p)=Y(p,q);
   Y(q,q)=Y(q,q)+1./(B1(i,3)*B1(i,5)^2)+B1(i,4)./2;
   Y(p,p)=Y(p,p)+1./B1(i,3)+B1(i,4)./2;
end
G=real(Y);B=imag(Y);
for i=1:n 
    e(i)=real(B2(i,3));
    f(i)=imag(B2(i,3));
    V(i)=B2(i,4);
end
for i=1:n 
    S(i)=B2(i,1)-B2(i,2);
    B(i,i)=B(i,i)+B2(i,5);
end
P=real(S);Q=imag(S);
T1=0;N=2*(n-1);
while 1
   if T1>10
       break;
   end;
   for i=1:n
        if i~=isb 
            C(i)=0;
            D(i)=0;
            for j1=1:n 
                C(i)=C(i)+G(i,j1)*e(j1)-B(i,j1)*f(j1);
                D(i)=D(i)+G(i,j1)*f(j1)+B(i,j1)*e(j1);
            end
            P1=C(i)*e(i)+f(i)*D(i);
            Q1=f(i)*C(i)-D(i)*e(i);
            V2=e(i)^2+f(i)^2;
            if B2(i,6)~=3
               DP=P(i)-P1;
               DQ=Q(i)-Q1;
               for j1=1:n
                    if j1~=i&j1~=isb 
                        X1=-G(i,j1)*e(i)-B(i,j1)*f(i);
                        X2=B(i,j1)*e(i)-G(i,j1)*f(i);
                        X3=X2;
                        X4=-X1;
                        p=2*i-1;q=2*j1-1;J(p,q)=X3;K(p,1)=DQ;m=p+1;
                        J(m,q)=X1;K(m,1)=DP;q=q+1;J(p,q)=X4;J(m,q)=X2;
                    elseif j1==i&j1~=isb 
                        X1=-C(i)-G(i,i)*e(i)-B(i,i)*f(i);
                        X2=-D(i)+B(i,i)*e(i)-G(i,i)*f(i);
                        X3=D(i)+B(i,i)*e(i)-G(i,i)*f(i);
                        X4=-C(i)+G(i,i)*e(i)+B(i,i)*f(i);
                        p=2*i-1;q=2*j1-1;J(p,q)=X3;K(p,1)=DQ;m=p+1;
                        J(m,q)=X1;K(m,1)=DP;q=q+1;J(p,q)=X4;J(m,q)=X2;
                    end
                end
            else DP=P(i)-P1;
                 DV=V(i)^2-V2;                 
                for j1=1:n
                    if j1~=isb&j1~=i 
                        X1=-G(i,j1)*e(i)-B(i,j1)*f(i);
                        X2=B(i,j1)*e(i)-G(i,j1)*f(i);
                        X5=0;
                        X6=0;
                        p=2*i-1;q=2*j1-1;J(p,q)=X5;K(p,1)=DV;m=p+1;
                        J(m,q)=X1;K(m,1)=DP;q=q+1;J(p,q)=X6;J(m,q)=X2;
                    elseif j1==i&j1~=isb 
                        X1=-C(i)-G(i,i)*e(i)-B(i,i)*f(i);
                        X2=-D(i)+B(i,i)*e(i)-G(i,i)*f(i);
                        X5=-2*e(i);
                        X6=-2*f(i);
                        p=2*i-1;q=2*j1-1;J(p,q)=X5;K(p,1)=DV;m=p+1;
                        J(m,q)=X1;K(m,1)=DP;q=q+1;J(p,q)=X6;J(m,q)=X2;
                    end
                end
            end
        end 
   end
    M=-Gauss_(J,K);disp(K);
    for i=1:2:N-1
    L=(i+1)/2;
    e(L)=e(L)+M(i,1);
    k1=i+1;
    f(L)=f(L)+M(k1,1);
    end
    det=max(abs(K));
    if det<=jd;
       break;
    end  
    T1=T1+1;
end;
disp(T1);
disp(e);disp(f);
disp(K);