牛拉法解非线性方程的程序

lianghuan

我写了一个关于牛拉法解非线性方程的程序，进行故障测距的。但结果总是发散，哪位同行前辈或高手帮忙看看，到底哪出错了呀？
% N' }' C4 E6 H0 i4 ?1 ~0 ]) p' g+ q6 ] 万分感激

; m* e* h* D) j! Q/ N+ G$ yfunction nlf2 =nlf2(Um1,Um2,Un1,Un2,Im1,Im2,In1,In2,r1,Zc1)
x=150%迭代过程没问题
7 G; w5 C. a: |* i/ `8 h* LL=300;
kk=0;
e=1;
4 j2 T2 f& f! D0 ]0 D1 D5 R%使用牛顿-拉夫逊法迭代求解
while (kk<10000&&e>0.001)
%A=(Um1*cosh(r1*x)-Im1*Zc1*sinh(r1*x))*(Un2*cosh(r1*(L-x))-In2*Zc1*sinh(r1*(L-x)))...
%  -(Um2*cosh(r1*x)-Im2*Zc1*sinh(r1*x))*(Un1*cosh(r1*(L-x))-In1*Zc1*sinh(r1*(L-x)));
   %对A展开整理得(sinh(x))'=cosh(x) 　　(cosh(x))'=sinh(x)
  D=(Um1*Un2-Um2*Un1)*(cosh(r1*x)*cosh(r1*(L-x)))...
2 n3 [/ M4 t0 Y, H0 m/ x1 ]& Q   +(Um2*In1*Zc1-Um1*In2*Zc1)*(cosh(r1*x)*sinh(r1*(L-x)))...
   +(Im2*Un1*Zc1-Un2*Im1*Zc1)*(sinh(r1*x)*cosh(r1*(L-x)))...
: Z$ G1 o  z$ ?. ^+ x- ~" K: j   +(Im1*In2*(Zc1.^2)-Im2*In1*(Zc1.^2))*(sinh(r1*x)*sinh(r1*(L-x)))
    f1 = real(D);
* I( `; e" Q, K$ _0 I3 O+ q4 b    f2 = imag(D);
    f = [f1,f2].'
  %A对x求偏导数
  B1=(Um1*Un2-Um2*Un1)*(r1*sinh(r1*x)*cosh(r1*L-r1*x)-r1*cosh(r1*x)*sinh(r1*L-r1*x))...
# B, F9 {; ^6 B- h- d! y    +(Um2*In1*Zc1-Um1*In2*Zc1)*(r1*sinh(r1*x)*sinh(r1*L-r1*x)-r1*cosh(r1*x)*cosh(r1*L-r1*x))...
    +(Im2*Un1*Zc1-Un2*Im1*Zc1)*(r1*cosh(r1*x)*cosh(r1*L-r1*x)-r1*sinh(r1*x)*sinh(r1*L-r1*x))...
; `) `% O: j! N7 t5 |. s    +(Im1*In2*(Zc1.^2)-Im2*In1*(Zc1.^2))*(r1*cosh(r1*x)*sinh(r1*L-r1*x)-r1*cosh(r1*L-r1*x)*sinh(r1*x))
5 h% B" E/ p3 B- r       a11=real(B1);
! Z4 c: e2 m3 m9 p6 ^( C; j5 X, z       a21=imag(B1);
) `' m1 A1 p4 J+ d7 I& l& g  %A对L求偏导数
  B2=(Um1*Un2-Um2*Un1)*(r1*cosh(r1*x)*sinh(r1*L-r1*x))...
      +(Um2*In1*Zc1-Um1*In2*Zc1)*(r1*cosh(r1*x)*cosh(r1*L-r1*x))...
      +(Im2*Un1*Zc1-Un2*Im1*Zc1)*(r1*sinh(r1*x)*sinh(r1*L-r1*x))...
      +(Im1*In2*(Zc1.^2)-Im2*In1*(Zc1.^2))*(r1*cosh(r1*L-r1*x)*sinh(r1*x))
6 n% o8 P/ V! y4 J3 `      a12 = real(B2);
5 k/ T* W/ q) K! v- Y4 k      a22 = imag(B2);
9 E0 F9 n. y- b$ X% ~
. i) J! W6 i& l9 j# _% l. y     R = [a11, a12; a21, a22]
    RR=inv(R);
    detb=inv(R) * f
! O- N: A; D0 ~& J3 H$ q    %detb =R\f;
# Q$ y1 O6 ?! s5 v: F) S  L) ?     L=L-detb(1);
( H+ N6 i# D* d: G     x=x-detb(2);
( c8 ]4 O1 j( z" `* S; E6 r. c( |     e1=abs(detb(1));
     e2=abs(detb(2));
, N; m6 y3 b9 F9 H$ C) O  e     e=max(e1,e2)
     kk = kk + 1
end
nlf2 = [L,x]