关于matpower中目标函数修改的问题

clear;

clc;

errArr=[];

%%

%³õʼ»¯£¡£¡£¡

initial;

% Start clock

t1 = clock;

%%

ROU=sl'*MU_MIN+su'*MU_MAX;

MUt=SIGMA*ROU/(2*length(sl));%³õʼ¶ÔżÒò×ÓÓë³Í·£Òò×Ó¼ÆËã%

ik=0;%¼Æµü´ú´ÎÊý£¡£¡£¡

%µü´úÑ »·¹ý³Ì£¡£¡

while(abs(ROU)>=err)

$ H+ Q: v, E8 }& }
%%

& A' d' e2 c8 h8 r% f% z%Calcute h,g matrix

    ROU=sl'*MU_MIN+su'*MU_MAX;

        errArr=[errArr;ROU;];

    SIGMA=0;

    MU=SIGMA*ROU/(2*length(sl));         %ÖÐÐIJÎÊýÖÃÁã%

) M& M6 z4 f! C
for i=1:30

        temp=0;

7 G5 h8 \( d5 n8 b9 u$ R& s
for j=1:30

            temp=temp-V(j)*aY(i,j)*cos(Vth(i)-Vth(j)-Yth(i,j));

: m" T  @) o1 I# V( I2 g) f- @9 bend

% }3 v9 s* M% [' E$ C5 w
if (i>6)

            tPg=0;

9 W% I$ J1 M& O5 {' C+ @else

            tPg=Pg(i);

1 ]) t# y. ?6 q. @8 cend

        h(i)=tPg-Pd(i)+V(i)*temp;

  b" f# w( H. Q# c! Eend

! S- C3 l! }& E% u
for i=1:30

        temp=0;

- f% L4 \" d' m3 J2 Nfor j=1:30

            temp=temp-V(j)*aY(i,j)*sin(Vth(i)-Vth(j)-Yth(i,j));

6 [9 `, K4 V2 z0 D9 x- F
end

1 E  G4 t% d: A1 s1 @2 z
if (i>6)

            tQg=0;

: U+ {' |8 U" x/ P
else

            tQg=Qg(i);

3 y: [  E+ j: R, W, G
end

        h(i+30)=tQg-Qd(i)+V(i)*temp;

) P0 c& ~4 L5 Zend
7 ~9 A' u  W* M% X% Cal  h END

0 v" r/ D0 D! {" o. t

# y+ a( \; |+ Z4 w( H' g
for i=1:6

        g(i)=Pg(i);

        g(i+6)=Qg(i);

+ B! ^( I; S/ i9 f+ y
end

0 l; L; P& F! ]+ g" p0 y
for i=1:30

        g(i+12)=V(i);

2 ]0 k  G( A+ V' B* B# fend" j; J% m) U, p. Q0 K
% Cal  g  END

3 r7 V3 U9 Z1 }0 i6 T% y& c2 E
%Calcute h,g matrix END

3 {$ P9 x6 \1 D+ u! b%%

# v# ?4 v" K9 t% }%Calculate Jacobian&Hessian matix

, B2 Q8 k" C5 D0 g
%First Step: Jf,Hf

- j+ E& I) |! s' T
for i=1:6

        Jf(i)=2*gencost(i,5)*Pg(i)+gencost(i,6);

        Hf(i,i)=2*gencost(i,6);

5 s! N# l6 y/ E# zend

( E; b0 \0 J- h* E& o
%Second Step: Jh, hΪµÈʽԼÊø

8 S/ D" n5 A& |for i=1:6         %Ç°6ÐжÔPgÇóµ¼£¬ÓÉ´ËÒÑÇó³ö

        Jh(i,i)=1;

5 H/ t- q0 S* a" k
end

* [# A+ E2 a0 h8 tfor i=7:12        %7-12ÐжÔQgÇóµ¼£¬ÓÉ´ËÒÑÇó³ö

        Jh(i,i+24)=1;

2 B# S" Z8 ?/ ]. Q; [9 ?6 vend

: `% o' T: h/ k- _, tfor i=1:30       %ÐγÉ13-42ÐеÄ1-60ÁÐ

& t1 T2 g6 _" Q6 K8 V* Tfor j=1:30

            tempVp=0;

            tempVq=0;

$ d2 Y6 C3 P& {  w6 s" l( J5 R' e. A
if (j==i)

+ y: t+ G2 p- g" q3 |for k=1:30

                    tempVp=tempVp-V(k)*aY(j,k)*cos(Vth(j)-Vth(k)-Yth(j,k));

                    tempVq=tempVq-V(k)*aY(j,k)*sin(Vth(j)-Vth(k)-Yth(j,k));

* w9 `+ H  n" i: D# }+ nend

                Jh(12+j,i)=tempVp-aY(j,j)*V(j)*cos(Yth(j,j));

                Jh(12+j,30+i)=tempVq+aY(j,j)*V(j)*sin(Yth(j,j));

* u3 w) H' P+ E. g: A$ x( ?. felse

                Jh(12+j,i)=-aY(i,j)*V(i)*cos(Vth(i)-Vth(j)-Yth(i,j));

                Jh(12+j,30+i)=-aY(i,j)*V(i)*sin(Vth(i)-Vth(j)-Yth(i,j));

: k/ N2 _& b1 L+ _4 {2 e
end

; x2 ?, O3 w5 O6 ]end

! y6 R: h  f4 T' W, K" r% x2 }
end

3 b3 [/ k8 U7 J6 z6 t2 O; P
for i=1:30       %ÐγÉ43-72ÐеÄ1-60ÁÐ

+ Y: z1 ^( Y! y( I/ c) cfor j=1:30

            tempVp=0;

            tempVq=0;

$ B4 s4 r. Q5 f2 ~2 H0 n, wif (j==i)

- R6 p: J4 P" f. C0 qfor k=1:30

                    tempVp=tempVp+aY(j,k)*V(k)*sin(Vth(j)-Vth(k)-Yth(j,k));

                    tempVq=tempVq-aY(j,k)*V(k)*cos(Vth(j)-Vth(k)-Yth(j,k));

' B7 X# j. d) F: D. s' _end

                tempVp=tempVp-V(j)*aY(j,j)*sin(-Yth(j,j));

                tempVq=tempVq+V(j)*aY(j,j)*cos(-Yth(j,j));

                Jh(42+j,i)=V(i)*tempVp;

                Jh(42+j,30+i)=V(i)*tempVq;

* ?' n4 z" Q6 X# M, T  i. N
else

                Jh(42+j,i)=-aY(i,j)*V(i)*V(j)*sin(Vth(i)-Vth(j)-Yth(i,j));

                Jh(42+j,30+i)=aY(i,j)*V(i)*V(j)*cos(Vth(i)-Vth(j)-Yth(i,j));

4 {# i9 ^1 K. g2 n+ L$ Gend

' y: d- y) v/ x) p" O
end

3 _1 P7 U6 X1 i& tend

9 Q( L4 c! Y. X" Z
%Third Step: Hh

. N0 s$ i: t& r7 f2 x1 h, E2 k
%Óй¦²¿·Ö

7 [5 \, m  c6 S2 m# M; Z0 ifor i=1:30

% z: B8 O6 O8 R4 M5 q3 Q% W: pfor j=1:30

3 j6 `1 m7 C: O- J8 K3 n0 F6 ]+ G: _0 K& ?
for k=j:30

. P$ U' Z9 i0 `1 {, S! ]% kif (j==k&&i~=j)

                    Hh(j+12,k+12,i)=0;          %VV

                    Hh(j+42,k+42,i)=V(i)*aY(i,j)*V(j)*cos(Vth(i)-Vth(j)-Yth(i,j)); %%thth

0 n8 s0 l* ^- H
elseif (j==k&&i==j)

                    Hh(j+12,k+12,i)=-2*aY(j,j)*cos(Yth(i,i));  %VV

                    temp=0;                   %thth

( B& a% {8 p" F5 p* R! lfor l=1:30

                        temp=temp+aY(j,l)*V(l)*cos(Vth(j)-Vth(l)-Yth(j,l));

2 W$ P, M' V: Q0 v1 tend

                    temp=temp-aY(i,i)*V(i)*cos(-Yth(i,i));

                    Hh(j+42,k+42,i)=V(i)*temp;

/ p6 ?; p; D, A5 _* ]elseif (k==i)

                    Hh(j+12,k+12,i)=-aY(i,j)*cos(Vth(i)-Vth(j)-Yth(i,j));    %VV

                    Hh(k+12,j+12,i)=Hh(j+12,k+12,i);

                    Hh(j+42,k+42,i)=-V(i)*aY(i,j)*V(j)*cos(Vth(i)-Vth(j)-Yth(i,j));  %thth

                    Hh(k+42,j+42,i)=Hh(j+42,k+42,i);

0 r3 [2 x0 |5 u. J, ?$ W/ _8 c3 ]elseif (j==i)

                    Hh(j+12,k+12,i)=-aY(i,k)*cos(Vth(i)-Vth(k)-Yth(i,k));    %VV

                    Hh(k+12,j+12,i)=Hh(j+12,k+12,i);

                    Hh(j+42,k+42,i)=-V(i)*aY(i,k)*V(k)*cos(Vth(i)-Vth(k)-Yth(i,k));  %thth

                    Hh(k+42,j+42,i)=Hh(j+42,k+42,i);

  x7 S# |8 c, O& U5 W
end

  Y9 q: o  t, V+ _- Jend

6 f4 h7 e+ |* M. E4 L7 O9 l
end

8 `. x) E4 x3 Z. x8 p: h! H9 o
end! d: J! K( c8 ~# W! ]
%ÖÁ´ËÒÑÐγɣ¨13-42£¬13-42£©ºÍ£¨42-72£¬43-72£©

; D9 k$ r' U0 e5 p9 T  @for i=1:30

; _% W4 n; B1 p" Z" S; u9 v" c
for j=1:30

+ L' v1 ?' ]  r0 D! \$ ufor k=1:30

! g, F: }# s& i5 r3 s: Q7 Xif (j==k&&i~=j)

                    Hh(j+42,k+12,i)=-V(i)*aY(i,j)*sin(Vth(i)-Vth(j)-Yth(i,j));      %thV

, |; P' ^: d4 b/ T) \
elseif (j==k&&i==j)

                    temp=0;                   %thV

. J3 |1 ~' H  u& Z, T& C' q& ufor l=1:30

                        temp=temp+aY(j,l)*V(l)*sin(Vth(j)-Vth(l)-Yth(j,l));   

1 T/ }6 T( u6 s/ E2 U
end

                    Hh(j+42,k+12,i)=temp-V(i)*aY(i,i)*sin(-Yth(i,i));

; m- c( u3 p2 p- A
elseif (j==i)

                    Hh(j+42,k+12,i)=V(i)*aY(i,k)*sin(Vth(i)-Vth(k)-Yth(i,k));   %thV   

0 G1 Q: A/ J* G: S3 `
elseif (k==i)

                    Hh(j+42,k+12,i)=-V(j)*aY(i,j)*sin(Vth(i)-Vth(j)-Yth(i,j));  %thV

7 f0 W: a. |' W* Pend

& J4 b7 ~' R7 R+ \$ D6 o
end

$ t' j! c% P- n- P1 f" e( _
end

        Hh(13:42,43:72,i)=Hh(43:72,13:42,i)';

3 |3 B: y6 E6 v; N) w9 @end' C0 X: w+ e! E; s# X+ z
%ÖÁ´ËÒÑÐγɣ¨42-72£¬13-42£©ºÍ£¨13-42£¬43-72£©

0 C2 o. |0 e  D! e' M
%ÎÞ¹¦²¿·Ö

( U: p' R  ^, \. v1 `+ z( |
for i=1:30

8 {0 s" h! Y7 D% O0 e( b
for j=1:30

1 d; i5 u/ U9 ^0 r2 cfor k=j:30

. I; q$ }/ a# {if (j==k&&i~=j)

                    Hh(j+12,k+12,i+30)=0;          %VV

                    Hh(j+42,k+42,i+30)=V(i)*aY(i,j)*V(j)*sin(Vth(i)-Vth(j)-Yth(i,j)); %%thth

- J* x1 q% t: v9 t/ s! u9 b) Aelseif (j==k&&i==j)

                    Hh(j+12,k+12,i+30)=2*aY(j,j)*sin(Yth(i,i));  %VV

                    temp=0;                   %thth

; l, H& Z4 Y& g! \for l=1:30

                        temp=temp+aY(j,l)*V(l)*sin(Vth(j)-Vth(l)-Yth(j,l));

: C0 n- Q4 J0 m$ N2 G; |end

                    temp=temp-aY(i,i)*V(i)*sin(-Yth(i,i));

                    Hh(j+42,k+42,i+30)=V(i)*temp;

$ C. z! i) {& b1 N! e! ?elseif (k==i)

                    Hh(j+12,k+12,i+30)=-aY(i,j)*sin(Vth(i)-Vth(j)-Yth(i,j));    %VV

                    Hh(k+12,j+12,i+30)=Hh(j+12,k+12,i+30);

                    Hh(j+42,k+42,i)=-V(i)*aY(i,j)*V(j)*sin(Vth(i)-Vth(j)-Yth(i,j));  %thth

                    Hh(k+42,j+42,i+30)=Hh(j+42,k+42,i+30);

' w, u. `1 @9 V- g
elseif (j==i)

                    Hh(j+12,k+12,i+30)=-aY(i,k)*sin(Vth(i)-Vth(k)-Yth(i,k));    %VV

                    Hh(k+12,j+12,i+30)=Hh(j+12,k+12,i+30);

                    Hh(j+42,k+42,i+30)=-V(i)*aY(i,k)*V(k)*sin(Vth(i)-Vth(k)-Yth(i,k));  %thth

                    Hh(k+42,j+42,i+30)=Hh(j+42,k+42,i+30);

% v/ o" G& p3 A) R
end

6 ^; a% A# Z0 C* Q+ U, _) H* pend

7 c8 @) Q( L, ?
end

6 q3 j( P: u, {+ t; u2 Pend
$ u9 `4 n$ N! _2 {: p%ÖÁ´ËÒÑÐγɣ¨13-42£¬13-42£©ºÍ£¨42-72£¬43-72£©

. ~" Z0 @! @& N
for i=1:30

% R2 i# j$ ?  D& Efor j=1:30

' t% R- N7 ~5 T; ~3 Z! ]
for k=1:30

7 }# C9 e5 Z1 `6 Oif (j==k&&i~=j)

                    Hh(j+42,k+12,i+30)=V(i)*aY(i,j)*cos(Vth(i)-Vth(j)-Yth(i,j));      %thV

/ c& W" |5 j; T  h) @elseif (j==k&&i==j)

                    temp=0;                   %thV

) S& q. J8 {- n# s
for l=1:30

                        temp=temp-aY(j,l)*V(l)*cos(Vth(j)-Vth(l)-Yth(j,l));   

1 N) o2 Q: ~. A! J' {7 W
end

                    Hh(j+42,k+12,i+30)=temp+V(i)*aY(i,i)*cos(-Yth(i,i));

1 ^6 t: g0 [+ h7 e0 e% D
elseif (j==i)

                    Hh(j+42,k+12,i+30)=-V(i)*aY(i,k)*cos(Vth(i)-Vth(k)-Yth(i,k));   %thV   

8 [  E+ h" h4 O$ Felseif (k==i)

                    Hh(j+42,k+12,i+30)=V(j)*aY(i,j)*cos(Vth(i)-Vth(j)-Yth(i,j));  %thV

; D  ~  B% y: mend

  ^5 q- X3 y$ v9 n/ Q$ e* J
end

) L: j% _1 l1 Aend

        Hh(13:42,43:72,i+30)=Hh(43:72,13:42,i+30)';

9 P( H5 ]9 h- S( m6 W) P( l- H9 [
end
# a5 O1 y* b' ~+ A$ R3 @4 R%ÖÁ´ËÒÑÐγɣ¨42-72£¬13-42£©ºÍ£¨13-42£¬43-72£©

! b. J7 i5 _' W; x; H% W' o%HhÐγÉÍê±Ï

. [! M# o7 H+ H* G$ i, T. f& O
%Fourth Step: Jg, Hg

    Jg=eye(42,42);

    Jg=[Jg;zeros(30,42)];

    Hg=zeros(72);

8 }9 E* A5 S- x) f%Calculation Jacobian&Hessian matrix END

8 t6 T* K/ g) D2 a9 f0 A%%

6 c( C' ^! F% O# i1 H
%Calculate Newton Iteration Îó²îµü´úÁ¿

% w% i4 ~" K8 m2 S/ k
%Cal LX0-------------------------1

    LX0=Jf-Jh*Lam+Jg*(-MU_MIN+MU_MAX);

  Q% I* ]: s2 c; E0 o0 Y%Cal LLam-------------------------2

    LLam0=h;

    pferr=max(LLam0);

! Y3 ]. ^3 B) Q7 v) W/ Q# [%Cal LMU_MIN-------------------------3

    LMU_MIN0=g-sl-gmin;

$ [# }7 f7 O: R3 I5 K) e
%Cal LMU_MAX-------------------------4

    LMU_MAX0=g+su-gmax;

( L1 B$ X6 |% @9 P%Cal Lsl-------------------------5

    Lsl0=diag(MU_MIN)*diag(sl)*ones(length(sl),1)-MU*ones(length(sl),1);

% M2 _# Z# c2 w9 J& M7 f  D
%CAl Lsu-------------------------6

    Lsu0=diag(MU_MAX)*diag(su)*ones(length(su),1)-MU*ones(length(su),1);

( J$ ?/ ]5 X' t, g%Calculate Newton Iteration Îó²îµü´úÁ¿ END!!!

* m" ~* y5 K  L: q* t
%%

# n5 N" c, H* v7 z/ A8 i" P/ J%Calculate Newton Iteration ·ÂÉäÐÞÕýÁ¿

3 o* f7 o7 I( p: ?# w9 o
%1st Step: ·ÂÉäÐÞÕýÁ¿delXaf,·ÂÉäÐÞÕýÁ¿delLamaf

- m) H0 k; x/ J0 v# K: G%S1:H

     temp=0;  %֮ǰÒÑÓùýÁÙʱ±äÁ¿temp£¬ÔÚ´ËÇåÁã

/ N; f( ~3 I" Y" ~* n  e
for i=1:60

         temp=temp+Lam(i)*Hh(:,:,i);

9 y- P3 `5 j- A+ q: e% d9 \0 yend

     tempgMUg1=0;

     tempgMUg1=Jg*diag(MU_MIN)*Jg';

2 m/ z; h3 _( P, lfor i=1:42

         tempgMUg1(i,:)=tempgMUg1(i,:)/sl(i);        

3 H- k6 O8 R1 p7 uend

     tempgMUg2=0;

     tempgMUg2=Jg*diag(MU_MAX)*Jg';

' |4 _; ~1 E+ A: A$ S6 L9 d: m
for i=1:42

             tempgMUg2(i,:)=tempgMUg2(i,:)/su(i);

7 @" F1 C- c# `, l9 ^: @8 E' zend

     H=Hf-temp+tempgMUg1+tempgMUg2;

( Q9 E% ]% ?% P! h$ y1 r" d%S2:·ÂÉäKESAaf

     tempgMUg1=0;

     tempgMUg1=diag(MU_MIN)*sl+diag(MU_MIN)*LMU_MIN0;

2 ^; P/ n2 Z9 ~. s% U* d# W& {
for i=1:42

         tempgMUg1(i)=tempgMUg1(i)/sl(i);

+ m8 I2 \: S' \. n$ `; z. Yend

     tempgMUg1=Jg*tempgMUg1;

     tempgMUg2=0;

     tempgMUg2=diag(MU_MAX)*su-diag(MU_MAX)*LMU_MAX0;

. _4 `% f2 [. i% d' D$ k
for i=1:42

             tempgMUg2(i)=tempgMUg2(i)/su(i);

; u- s7 |* H, f: R
end

     tempgMUg2=Jg*tempgMUg2;

     KESAaf=LX0+tempgMUg1-tempgMUg2;

0 |' |6 @- [: Z& |$ |( n
%S3:JACOBIAN

     JACOBIAN=[H -Jh;Jh' zeros(60)];

) `; H) T+ Q* m9 c2 O: {1 U%S4£ºRESULT

     RESULT=-[KESAaf;LLam0];

; l  t  k4 u% q7 k& l
%S5:Cal ·ÂÉäÐÞÕýÁ¿delXaf,·ÅÉäÐÞÕýÁ¿delLamaf

     delXaf=-Jh'\LLam0;

     delLamaf=Jh\(H*delXaf+KESAaf);

%      temp=JACOBIAN\RESULT;

%      for i=1:72

%          delX(i)=temp(i);

%      end

%      for i=1:60

%          delLam(i)=temp(i+72);

%      end

% d( v9 Z6 u$ Y8 s

7 r2 s; J* r5 j# ^+ n7 z" _
%2nd Step: ·ÅÉäËɳڱäÁ¿ÐÞÕýÁ¿delslaf, delsuaf

0 ~5 N) t! y) c: S) a4 J" F" w%S1: delslaf

     delslaf=Jg'*delXaf+LMU_MIN0;

9 t! Y; W4 s8 S4 C
%S2: delsuaf

     delsuaf=-Jg'*delXaf-LMU_MAX0;

% x+ N  r% v- ]& Q* o+ k' W% b

9 r7 [6 [" n3 D
%3rd Step: ·ÅÉäÀ ¸ñÀÊÈÕ³Ë×ÓÐÞÕýÁ¿delMU_MINaf,delMU_MAXaf

% ^+ z! M' A  M8 ]5 @6 }3 v& P; ]
%S1: delMU_MINaf

     temp=0;

     temp=-Lsl0-diag(MU_MIN)*delslaf;

) R9 w  d; x/ ?' L# G4 L2 d! Pfor i=1:42

         temp(i)=temp(i)/sl(i);

# W* s& C6 V. n# }: f' ]
end

     temp(13)=0;

     delMU_MINaf=temp;

' R6 v- E* d  [9 D- j! \1 @
%S2: delMU_MAXaf

     temp=0;

     temp=-Lsu0-diag(MU_MAX)*delsuaf;

% |+ X$ G& n9 x, T& @
for i=1:42

         temp(i)=temp(i)/su(i);

% A+ S, Z4 Z6 F0 W' A. }) ?: cend

     temp(13)=0;

     delMU_MAXaf=temp;

% N9 n. Q# k+ O2 c9 a  M- l) Y

& m- w% V% _/ t0 R1 x
%Calculate Newton Iteration ·ÂÉäÐÞÕýÁ¿ END!!!!!!!!!!!!!!

8 C2 j) V7 R2 s' \8 M

* k# c8 l9 m- u+ l' Q9 H2 F, t2 |%%

  d" P4 [* F8 s4 ?/ X: X- n' |, e%¼ÆËã·ÂÉäÔ Ê¼²½³¤ºÍ¶Ôż²½³¤ STEPpaf£¬ STEPdaf

" w5 b% E3 e1 \7 B) W%S1: STEPpaf

4 a0 Y- p5 p- s1 u2 ofor i=1:42

5 N! Q: i0 P1 r+ Kif (delslaf(i)~=0)

            temp1=-sl(i)/delslaf(i);

, o! q7 g2 @: Q& M! celse

            temp1=Inf;

2 R! o: ^7 B7 Y: C& N6 F& x9 R+ U; W2 Aend

9 ?$ E/ a% I7 ?% p: Bif (delsuaf(i)~=0)

            temp2=-su(i)/delsuaf(i);

+ A% P. U5 R& velse

            temp2=Inf;

+ i, e5 y/ `! }( P3 A% L
end

" U* R7 I$ O# \" w7 V) Z5 t! Xif temp1<temp2

            min=temp1;

1 s5 Y* D& ~; _! i% Celse

            min=temp2;

, J" |) G. L9 P- T0 w# ?
end

! S( W1 g# U/ n  Y. D/ i9 T3 o5 uif min>1

            min=1;

$ S3 G4 l, B! s# w& i
end

7 i. e1 j, ^; l0 s. d
end

    STEPpaf=0.9995*min;

8 ^- y7 h+ a6 A8 {- y
%S2: STEPdaf

1 I6 g5 q0 k, c' ]for i=1:42

        temp1=-MU_MIN(i)/delMU_MINaf(i);

        temp2=-MU_MAX(i)/delMU_MAXaf(i);

/ v, e6 \2 I4 U; z8 b
if temp1<temp2

            min=temp1;

6 i4 p" ?0 o; b( f5 U1 y! {
else

            min=temp2;

" y. t1 u: Z/ g7 P2 rend

; j( Y! P# ~3 i2 h* Z& W+ K' D
if (i==13)

            min=0;

1 a+ l& T* K  H: R) `! `- |1 p* d- f6 Yend

5 l9 ?. m. w* Y* C4 m4 J7 w! Yif min>1

            min=1;

+ k' C) C. q1 ]# K! r! G7 xend

6 |7 Z4 S6 R' J4 M% Xend

    STEPdaf=0.9995*min;

  A5 C- X# c  `& \% W
%&frac14;&AElig;&Euml;&atilde;·&Acirc;&Eacute;&auml;&Ocirc; &Ecirc;&frac14;&sup2;&frac12;&sup3;¤&ordm;&Iacute;&para;&Ocirc;&Aring;&frac14;&sup2;&frac12;&sup3;¤ STEPp&pound;&not; STEPd END!!!!!

2 x( }- y8 t0 y  D+ l* ?7 b+ a

: G! `& U6 k* d" J" T%&frac14;&AElig;&Euml;&atilde;·&Acirc;&Eacute;&auml;&para;&Ocirc;&Aring;&frac14;&Ograve;ò&Ecirc;&yacute;&frac14;°&sup3;&Iacute;·&pound;&Ograve;ò×&Oacute;%

   ROUaf=(sl+STEPpaf*delslaf)'*(MU_MIN+STEPdaf*delMU_MINaf)+(su+STEPpaf*delsuaf)'*(MU_MAX+STEPdaf*delMU_MAXaf);

$ Z2 g5 J  g/ w& t& g
if (ROUaf/ROU)^2<0.2

       SIGMA=(ROUaf/ROU)^2;

  X% l4 y: w( xelse

       SIGMA=0.2;

8 y) G( g/ Z* L' f! C& n1 X, Tend

   MUaf=SIGMA*ROUaf/(2*length(sl));

+ z& h0 e$ G& l5 \7 w
%&frac14;&AElig;&Euml;&atilde;&Iacute;ê±&Iuml;%

   Lsl0=diag(MU_MIN)*diag(sl)*ones(length(sl),1)-MUaf*ones(length(sl),1)-diag(delslaf)*delMU_MINaf;

   Lsu0=diag(MU_MAX)*diag(su)*ones(length(su),1)-MUaf*ones(length(su),1)-diag(delsuaf)*delMU_MAXaf;

+ M0 L2 W) d, ?/ a
%Calculate Newton Iteration &ETH;&THORN;&Otilde;&yacute;&Aacute;&iquest;

) I' e1 ], f+ P%1st Step: &ETH;&pound;&Otilde;&yacute;&ETH;&THORN;&Otilde;&yacute;&Aacute;&iquest;delX,&ETH;&THORN;&Otilde;&yacute;&Aacute;&iquest;delLam

5 G2 i7 U6 X) T' U' w& P  T7 }
%S1:H

     temp=0;  %&Ouml;&reg;&Ccedil;°&Ograve;&Ntilde;&Oacute;&Atilde;&sup1;&yacute;&Aacute;&Ugrave;&Ecirc;±±&auml;&Aacute;&iquest;temp&pound;&not;&Ocirc;&Uacute;&acute;&Euml;&Ccedil;&aring;&Aacute;&atilde;

5 w: z. o4 e7 X! e
for i=1:60

         temp=temp+Lam(i)*Hh(:,:,i);

8 R9 W2 I; _+ Q. ^" `! S
end

     tempgMUg1=0;

     tempgMUg1=Jg*diag(MU_MIN)*Jg';

( i) g& l5 j" q. u" a1 e6 a! P7 s% Xfor i=1:42

         tempgMUg1(i,:)=tempgMUg1(i,:)/sl(i);        

% C/ c- g$ r/ S2 ~9 g" n8 @
end

     tempgMUg2=0;

     tempgMUg2=Jg*diag(MU_MAX)*Jg';

3 f; Z; u3 W3 a4 \, Z$ Cfor i=1:42

             tempgMUg2(i,:)=tempgMUg2(i,:)/su(i);

7 u  q- G; y$ a8 S% ]$ y3 Bend

     H=Hf-temp+tempgMUg1+tempgMUg2;

. R+ n( t* p4 k* e/ A. e1 E
%S2:&ETH;&pound;&Otilde;&yacute;KESA

     tempgMUg1=0;

     tempgMUg1=Lsl0+diag(MU_MIN)*LMU_MIN0+diag(delslaf)*delMU_MINaf;

" z% P  S( f: k  s, ^' Lfor i=1:42

         tempgMUg1(i)=tempgMUg1(i)/sl(i);

' d) M8 h; Z! d$ g
end

     tempgMUg1=Jg*tempgMUg1;

     tempgMUg2=0;

     tempgMUg2=Lsu0-diag(MU_MAX)*LMU_MAX0+diag(delsuaf)*delMU_MAXaf;

' z- U* j# F: ^% R1 ^1 ofor i=1:42

             tempgMUg2(i)=tempgMUg2(i)/su(i);

5 N# q0 W+ z2 |! A
end

     tempgMUg2=Jg*tempgMUg2;

     KESA=LX0+tempgMUg1-tempgMUg2;

. c! R3 Z3 `3 y$ v# R+ M  X; U
%S3:JACOBIAN

     JACOBIAN=[H -Jh;Jh' zeros(60)];

. s- d4 d! E* d% Z- \: u
%S4&pound;&ordm;RESULT

     RESULT=-[KESA;LLam0];

# p- _, T6 t# o0 i9 ?9 L. \# ~( x%S5:Cal &ETH;&pound;&Otilde;&yacute;&ETH;&THORN;&Otilde;&yacute;&Aacute;&iquest;delX,&ETH;&THORN;&Otilde;&yacute;&Aacute;&iquest;delLam

     delX=-Jh'\LLam0;

     delLam=Jh\(H*delX+KESA);

%      temp=JACOBIAN\RESULT;

%      for i=1:72

%          delX(i)=temp(i);

%      end

%      for i=1:60

%          delLam(i)=temp(i+72);

%      end

7 q$ j& z% E+ Z: U# Q

# h, z5 P4 n) s  S8 ~; m
%2nd Step: &ETH;&pound;&Otilde;&yacute;&Euml;&Eacute;&sup3;&Uacute;±&auml;&Aacute;&iquest;&ETH;&THORN;&Otilde;&yacute;&Aacute;&iquest;delsl, delsu

& V, L. B$ Q% v1 f- |* g
%S1: delsl

     delsl=Jg'*delX+LMU_MIN0;

; u, l, a4 `) k/ y) R+ [# ]. i%S2: delsu

     delsu=-Jg'*delX-LMU_MAX0;

$ }) r6 P# Q$ f$ d9 e! ]7 H7 D

# u- s+ u( T" q& g
%3rd Step: &ETH;&pound;&Otilde;&yacute;&Agrave; &cedil;&ntilde;&Agrave;&Ecirc;&Egrave;&Otilde;&sup3;&Euml;×&Oacute;&ETH;&THORN;&Otilde;&yacute;&Aacute;&iquest;delMU_MIN,delMU_MAX

' y8 r2 e- l+ t$ k+ L3 }%S1: delMU_MIN

     temp=0;

     temp=-diag(MU_MIN)*sl+MUt*ones(42,1)-diag(delMU_MINaf)*delslaf-diag(MU_MIN)*delslaf;

- \' @4 ^$ C  G. B8 m5 Dfor i=1:42

         temp(i)=temp(i)/sl(i);

" |# W1 _  Q, |+ J: X
end

     temp(13)=0;

     delMU_MIN=temp;

  j; _9 o, f1 `# X' P1 w& h0 Q& m%S2: delMU_MAX

     temp=0;

     temp=-diag(MU_MAX)*su+MUt*ones(42,1)-diag(delMU_MAXaf)*delsuaf-diag(MU_MAX)*delsuaf;

/ i( S$ @- B$ V" j7 Ofor i=1:42

         temp(i)=temp(i)/su(i);

, P* B3 r+ ]* H3 h% w& X9 t+ u
end

     temp(13)=0;

     delMU_MAX=temp;

4 V; p+ S% |2 C! _$ n7 l! o$ e

# N6 j3 d0 ]+ j, t; q8 y$ I- d
%Calculate Newton Iteration &ETH;&THORN;&Otilde;&yacute;&Aacute;&iquest; END!!!!!!!!!!!!!!

, G* |1 N& d' c5 x; S% v7 Q' `1 q%%

  M& r  g# {# Z8 z%&frac14;&AElig;&Euml;&atilde;&ETH;&pound;&Otilde;&yacute;&Ocirc; &Ecirc;&frac14;&sup2;&frac12;&sup3;¤&ordm;&Iacute;&para;&Ocirc;&Aring;&frac14;&sup2;&frac12;&sup3;¤ STEPp&pound;&not; STEPd

4 \" B( a$ F, f6 }- m" I5 L/ S7 d%S1: STEPp

# r) M; g* D0 Y1 [9 F
for i=1:42

3 [1 C6 G/ M; W; Q% B0 M4 I7 [+ H
if (delslaf(i)~=0)

            temp1=-sl(i)/delsl(i);

! T3 @4 }) z9 s3 Jelse

            temp1=Inf;

! f* z; o8 v5 K- _- r5 m* h- c
end

$ |/ K' e% Q% N2 d  u& @$ P
if (delsuaf(i)~=0)

            temp2=-su(i)/delsu(i);

7 G- {$ p& i7 Q3 S9 |2 xelse

            temp2=Inf;

/ `& K# t# }6 O. i" u7 h4 B
end

- d: E/ i3 o1 m- G5 H+ e, y- \
if temp1<temp2

            min=temp1;

5 t) L0 V0 ?5 T2 h1 l* G3 `
else

            min=temp2;

% x% V" O# X  D; Q) ^7 }9 Gend

/ |8 r9 e/ {# R+ i0 F+ T' {
if min>1

            min=1;

; V, d, J* S; k: m7 e6 B. k0 M
end

: h) a: y+ L! s, L. g4 g6 S" @! U
end

    STEPp=0.9995*min;

$ G5 R6 e! A& S) R
%S2: STEPd

8 |5 w' a: Q# ?; A# |7 ~
for i=1:42

        temp1=-MU_MIN(i)/delMU_MIN(i);

        temp2=-MU_MAX(i)/delMU_MAX(i);

" [( C4 v3 A9 X) Vif temp1<temp2

            min=temp1;

& L+ p5 y' P( E3 i* K& h7 A
else

            min=temp2;

$ o# R  n% u1 \$ V2 I9 `3 h
end

0 U; N* O: K+ h' J$ N
if (i==13)

            min=0;

# x6 X; ]& V: r, M5 ]: }
end

0 |/ b2 C( h' ~& ]1 N
if min>1

            min=1;

. O3 q" b' ?/ s! a& T# }+ p& p
end

5 l' E/ n3 j3 l) dend

    STEPd=0.9995*min;

! S+ y* L/ @, H# W9 ?% _0 m  h. J4 Y) K/ x%&cedil;ü&ETH;&Acirc;&Ocirc; &Ecirc;&frac14;±&auml;&Aacute;&iquest;&ordm;&Iacute;&para;&Ocirc;&Aring;&frac14;±&auml;&Aacute;&iquest;

   X=X+STEPp*delX;

   Lam=Lam+STEPd*delLam;

   sl=sl+STEPp*delsl;

   su=su+STEPp*delsu;

   MU_MIN=MU_MIN+STEPd*delMU_MIN;

   MU_MAX=MU_MAX+STEPd*delMU_MAX;

   Pg=X(1:6);Qg=X(7:12);V=X(13:42);Vth=X(43:72);

9 l: |! I0 P2 G! D) ]%&cedil;ü&ETH;&Acirc;&Ocirc; &Ecirc;&frac14;±&auml;&Aacute;&iquest;&ordm;&Iacute;&para;&Ocirc;&Aring;&frac14;±&auml;&Aacute;&iquest; END!!!

$ R4 Z( S4 J1 _3 @1 F

4 K! ]- q# a) L2 I) t0 u6 E
%&frac14;&AElig;&Euml;&atilde;&para;&Ocirc;&Aring;&frac14;&frac14;&auml;&Iuml;&para;%

   ROU=sl'*MU_MIN+su'*MU_MAX;

   MUt=SIGMA*ROU/(2*length(sl));

7 r: o- x# R+ B) {; }4 X  x%%

1 `9 `# V5 x9 k+ ]7 S9 s) p%&Aring;&ETH;&para;&Iuml;&Ecirc;&Ccedil;·&ntilde;&sup3;&not;&sup1;&yacute;&micro;ü&acute;ú&acute;&Icirc;&Ecirc;&yacute;

    ik=ik+1;

2 ~4 a# F( j% p  ~
if ik>IterNumMAX

        disp('IterNum ERROR!!!!!');

' R+ W: E  \" h$ |2 a( ~break;

( c. y5 |; B, o6 t' o* H
end

8 P7 T3 G* u* e9 g9 {5 I

end

et = etime(clock, t1);

%%

%&Ecirc;&auml;&sup3;&ouml;&sup2;&iquest;·&Ouml;

" _* U1 ?7 }+ _# m$ O+ r

if (ik<=IterNumMAX)

) ]2 m& V4 M- H0 K" a. r
%%

$ I# t5 E3 Q" ]4 e: o- L%&Ccedil;ó&micro;&Atilde;×&icirc;&acute;ó×&icirc;&ETH;&iexcl;&micro;&Egrave;&Ecirc;&frac12;&Icirc;ó&sup2;&icirc;

    F=0;

for i=1:6

    F=F+gencost(i,5)*(X(i)*baseMVA)^2+gencost(i,6)*X(i)*baseMVA;

end

9 F9 B1 }" q' L; [

max=-10;min=10;

for i=1:ik

    temp=LLam0(i);

9 ]( T  I  o  R5 c% @
if (temp>max) max=temp;

& S5 V" Z! S: \
end

5 h# `% k+ R6 L: w4 m$ J
if (temp<min) min=temp;

+ Q# ~+ Z* n+ |2 `, \8 n
end

end

max

ik

%%

%&Ecirc;&auml;&sup3;&ouml;&frac12;á&sup1;&ucirc;

    fprintf('\nConverged in %.2f seconds', et);

    fprintf('\nObjective Function Value = %.2f $/hr', F);

    fprintf('\n================================================================================');

    fprintf('\n|     Bus Data                                                                 |');

    fprintf('\n================================================================================');

    fprintf('\n Bus      Voltage          Generation             Load        ');

    fprintf('  Lambda($/MVA-hr)');

    fprintf('\n  #   Mag(pu) Ang(deg)   P (MW)   Q (MVAr)   P (MW)   Q (MVAr)');

    fprintf('     P        Q   ');

    fprintf('\n----- ------- --------  --------  --------  --------  --------');

    fprintf('  -------  -------');

5 g8 l, |7 h" s5 ofor i = 1:30

        fprintf('\n%5d%7.3f%9.3f', i,X(i+12),X(i+42)*180/pi);

6 \' x- R4 Z1 _7 l' b- O3 \# sif (i<=6)

            fprintf('%10.2f%10.2f', X(i)*baseMVA, X(i+6)*baseMVA);

. l& m. h5 M5 melse

            fprintf('       -         -  ');

* T2 N1 @3 W, N% f1 Yend

        fprintf('%10.2f %9.2f', bus(i, 3) , bus(i, 4) );

        fprintf('%9.3f %9.3f', Lam(i),Lam(i+30));

6 U5 w- G3 c; |4 F) n& e' ]  I
if (i==30)

            fprintf('\n                        --------  --------  --------  --------');

            fprintf('\n               Total: %9.2f %9.2f',(X(1)+X(2)+X(3)+X(4)+X(5)+X(6))*baseMVA,(X(7)+X(8)+X(9)+X(10)+X(11)+X(12))*baseMVA)

            fprintf('\n');

- d" J% Q# ]4 uend

" `0 E8 z" H1 j! _* V0 L
end

! d( V2 F7 e5 ?) _%%

%%&Ecirc;&auml;&sup3;&ouml;&Ccedil;ú&Iuml;&szlig;&Auml;&acirc;&ordm;&Iuml;main

iterNum=[1:ik]';

%axis([0,ik+1,min,max]);

hold on;

f = fit(iterNum,errArr,'spline');

f=feval(f,iterNum);

plot(iterNum,errArr,'o',iterNum,f,'-');

end