G=[6.250 -5.000 -1.250 0 0;-5.000 10.834 -1.667 -1.667 -2.500;-1.250 -1.667 12.917 -10.000 0;0
-1.667 -10.000 12.917 -1.250;0 -2.500 0 -1.250 3.750];
B=[-18.750 15.000 3.750 0 0;15.000 -32.500 5.000 5.000 7.500;3.750 5.000 -38.750 30.000 0;0
5.000 30.000 -38.750 3.750;0 7.500 0 3.750 -11.250];
Y=G+j*B;
B1=B(2:5,2:5); BB1= B(2:5,2:5);
B1n=inv(B1);
BB1n=inv(BB1);
det=[0;0;0;0;0];
u=[1.06;1.0; 1.0; 1.0; 1.0] ;
p=[0;0.2;-0.45; -0.4; -0.6];
q=[0;0.2; -0.15;- 0.05; -0.10];
N1=5;
kp = 1;
kq = 1;
ep = 0.00001;
k = 0;
while (kp~=0&kq~=0)
k =k + 1;
for m=2:N1
for n=1:N1
pt(n)=u(m)*u(n)*(G(m,n)*cos(det(m)-det(n))+B(m,n)*sin(det(m)-det(n))) ;
end;
Dp(m)=p(m)-sum(pt);
end;
Dp;
if max(abs(Dp))<ep
kp = 0;
else
Ddet=-B1n*( Dp(2:5)'./u(2:5))./u(2:5);
Odet=Ddet'
det(2:5)=det(2:5)+Ddet;
kq=1;
end;
for m=2:N1
for n=1:N1
qt(n)=u(m)*u(n)*(G(m,n)*sin(det(m)-det(n))-B(m,n)*cos(det(m)-det(n)));
end;
Dq(m)= q(m)-sum(qt);
end;
o=Dq
if max(abs(Dq))<ep