You are on page 1of 2

clc;

clear all;
n=3;
Y=[20.0000-50.0000i -10.0000+20.0000i -10.0000+30.0000i; -10.0000+20.0000i
26.0000-52.0000i -16.0000+32.0000i;-10.0000+30.0000i -16.0000+32.0000i
26.0000-62.0000i];
bi=imag(Y);
br=real(Y);
th=angle(Y);
mY=abs(Y);
pd=[0 2.566 1.386];
pg=[0 0 0];
ps=pg-pd;
qd=[0 1.102 0.452];
qg=[0 0 0];
qs=qg-qd;
v=[1 1 1];
dl=[0 0 0];
dv=[0 0 0];
y=1;
rs=0.01;
xs=0.1;
rp=200;
k=0.9;
vdc=1;
thc=0;
zs=(rs+(sqrt(-1))*xs);
ys=abs(1/xs);
beta=angle(zs);

for iteration=1:100
if y<0.000001
break;
else
pg(3)=((k*ys*vdc*v(3)*cos(dl(3)-thc+beta))-(v(3)*v(3)*ys*cos(beta)));
qg(3)=((k*ys*vdc*v(3)*sin(dl(3)-thc+beta))-(v(3)*v(3)*ys*sin(beta)));
ps=pg-pd;
qs=qg-qd;
pac=((k*k*ys*vdc*vdc*cos(beta))-(vdc*k*v(3)*ys*cos(thc+beta-dl(3))));
pdc=(vdc*vdc)/rp;
for i=2:n
p(i)=0;
q(i)=0;
for j=1:n
p(i)=(v(i)*v(j)*mY(i,j)*cos(th(i,j)-dl(i)+dl(j)))+p(i);
q(i)=-(v(i)*v(j)*mY(i,j)*sin(th(i,j)-dl(i)+dl(j)))+q(i);
end
end
delp(1:2)=ps(2:3)-p(2:3);
delq(1:2)=qs(2:3)-q(2:3);
delpq=[0 0 0 0 0];
delpq=[delp delq];
delpq(5)=pac-pdc;
for i=2:n
for j=1:n
if i~=j
j1(i,j)=-(v(i)*v(j)*mY(i,j)*sin(th(i,j)-dl(i)+dl(j)));
j2(i,j)=(v(i)*v(j)*mY(i,j)*cos(th(i,j)-dl(i)+dl(j)));
j3(i,j)=-(v(i)*v(j)*mY(i,j)*cos(th(i,j)-dl(i)+dl(j)));
j4(i,j)=-(v(i)*v(j)*mY(i,j)*sin(th(i,j)-dl(i)+dl(j)));
end
end
end
for i=2:n
j1(i,i)=-q(i)-(bi(i,i)*v(i)^2);
j2(i,i)=p(i)+(br(i,i)*v(i)^2);
j3(i,i)=p(i)-(br(i,i)*v(i)^2);
j4(i,i)=q(i)-(bi(i,i)*v(i)^2);
end
J11(1:2,1:2)=j1(2:3,2:3);
J12(1:2,1:2)=j2(2:3,2:3);
J21(1:2,1:2)=j3(2:3,2:3);
J22(1:2,1:2)=j4(2:3,2:3);
J=[J11 J12;J21 J22];
J(1,4)=0;
J(1,5)=0;
J(3,4)=0;
J(3,5)=0;
J(5,1)=0;
J(5,3)=0;
J(2,2)=(((k*v(3)*ys*vdc*sin(dl(3)+beta-thc))+J(2,2)));
J(2,4)=-(k*ys*v(3)*vdc*cos(dl(3)+beta-thc));
J(2,5)=-(k*ys*v(3)*vdc*sin(dl(3)+beta-thc));
J(4,2)=-((k*v(3)*ys*vdc*cos(dl(3)+beta-thc))-J(4,2));
J(4,4)=-(k*v(3)*ys*vdc*sin(dl(3)+beta-thc));
J(4,5)=(k*v(3)*ys*cos(dl(3)+beta-thc));
J(5,2)=((v(3)*k*vdc*sin(thc+beta-dl(3)))*ys);
J(5,5)=-((v(3)*k*vdc*sin(thc+beta-dl(3)))*ys);
J(5,4)=-((2*k*k*vdc*cos(beta)*ys)-(v(3)*k*ys*cos(thc+beta-dl(3)))-
((2*vdc)/rp));
J;
del=(inv(J)*transpose(delpq));
ddl(2:3)=del(1:2);
dl=dl+ddl;
dv(2)=del(3);
v=v+dv;
vdc=vdc+del(4);
thc=thc+del(5);
y=(abs(dv(2)));
end
iteration
v
del
dl
J
delpq
vdc
thc

end

You might also like