hbmnewt
C HBMNEWT SOURCE OF166741 26/05/11 21:15:13 12538 *======================================================================= * * Methode de Newton-Raphson * * Convergence vers une solution des equations d'equilibre (frequentiel). * TYPC(1) indique le type de calcul a realiser: * = | 'I' : solution initiale * | 'C' : pas correcteur de la continuation * TYPC(2) indique le type de calcul a realiser: * = | 'F' : reponse Forcee * | 'A' : reponse Autonome * | 'N' : reponse libre : Non-linear normal modes * *======================================================================= & KPARNUM,KTLIAA,MTLIAB,KTFEX,MTPAS,LOCLFA, & LOCLB1,CHECK,TYPC,ITER) *----- Declarations ---------------------------------------------------- IMPLICIT INTEGER(I-N) IMPLICIT REAL*8(A-H,O-Z) -INC PPARAM -INC CCOPTIO -INC SMLREEL POINTEUR fvec.MLREEL -INC TMDYNC SEGMENT,mwrkl REAL*8 AVVP(NT),VCTCS(7),LAMBD(NDDL) REAL*8 gx(NT) REAL*8 AiDi(2),Di(2),bi(2) ENDSEGMENT CHARACTER*2 TYPC LOGICAL check LOGICAL NNM,JANAL2 INTEGER INFO REAL*8 fref,fref0 C Fonctions BLAS/LAPACK c NNM=(TYPC.EQ.'IN').OR.(TYPC.EQ.'CN') NNM=TYPC(2:2).EQ.'N' c*dbg write(ioimp,*) 'HBMNEWT : TYPC ='//TYPC//'=' * Segments MTQ = KTQ MTKAM = KTKAM MTEMP = KTEMP PARNUM = KPARNUM MTLIAA= KTLIAA c MTLIAB= KTLIAB MTFEX = KTFEX ITER=-1 c RELAX=1.d0 JANAL2=JANAL SEGINI,mwrkl JG=NT SEGINI,fvec fref = ZERO fref0 = ZERO c *------ Test de convergence pour la solution ------------------ c test=0.D0 c DO i=1,NT c IF(abs(fvec.prog(i)).GT.test) test=abs(fvec.prog(i)) c ENDDO *------ Calcul de la raideur dynamique tangente des efforts lineaires -- * Matrice liee a la base modale (avec ou sans terme dissipatif selon NNM) * cas Granger-Paidoussis : rajouter raideur de couplage c aussi pour cas NNM ? a voir... IF (.NOT. NNM) THEN DO J = 1,IPALA(/1) IF (IPALA(J,1).EQ.5 .AND. IPALA(J,3).EQ.101) THEN DO IJ = 1,7 VCTCS(IJ) = XPALA(J,IJ) ENDDO IF (TYPC.EQ.'CA') THEN VCTCS(4) = VV XPALA(J,4) = VV ENDIF JG = NDDL MLREE1 = IPALA(J,7) MLREE2 = IPALA(J,4) MLREE3 = IPALA(J,8) c SEGACT, MLREE1,MLREE2,MLREE3 DO IJ = 1,JG ENDDO c * Nombre de termes fixe, a generaliser si besoin. c JG = 2 * tentative de generalisation DO IJ = 1,JG ENDDO c SEGDES,MLREE1,MLREE2,MLREE3 ENDIF ENDDO ENDIF *------ Calcul du residu initial --------------------------------------- * (lie a la prediction par exemple) its=0 & MTLIAB,MTPAS,MTFEX,LOCLFA,LOCLB1,JANAL2,fvec,fref0,NNM) IF (IIMPI.GE.2) THEN WRITE(IOIMP,990) its,OMEG,Q1NRM2,res,fref0,DS c IF (IIMPI.GE.333) THEN c WRITE(IOIMP,111) 'Q',its,(Q1(iou),iou=1,NT) c WRITE(IOIMP,111) 'R',its,(fvec.prog(iou),iou=1,NT) c ENDIF ENDIF *============================= Iterations ============================== DO its=1,ITERMAX * ----- DIFFICULTE A CONVERGER : ON RELAXE (test non concluant) ---- c IF (its .GT. 10) THEN c RELAX=0.222d0 c ENDIF * ----- CALCUL DE LA JACOBIENNE : dR/dX = Z(OMEGA) - dFNLdX ---- DO J=1,NT DO I=1,NT RX(I,J) = ZZ(I,J)-JAC(I,J) ENDDO ENDDO c IF (IIMPI.GE.333) THEN c DO iou=1,NT c WRITE(IOIMP,111) 'RX_',iou,(RX(iou,jou),jou=1,NT) c ENDDO c ENDIF * ----- CAS 1: INITIALISATION (systeme force) ------------------ IF (TYPC.EQ.'IF') THEN * Calcul de la correction dX, telle que: Rx*dX = R * Appel a "DGESV" (LAPACK) DO M = 1,NT ENDDO c IF (IIMPI.GE.333) c & WRITE(IOIMP,111) 'dQ^',its,(fvec.prog(iou),iou=1,NT) cc si on souhaite verifier la convergence en correction dX cc res=dnrm2(NT,fvec.prog,1)/dnrm2(NT,Q1,1) ENDIF * ----- CAS 2: CONTINUATION (systeme force) -------------------- IF (TYPC.EQ.'CF') THEN * Calcul de la correction dY, telle que: Ja*dY = {R,0} * avec Ja la Jacobienne augmentee: Ja = {RX,Rw;dX,dw} DO JJ=1,NT DO II=1,NT Ja(II,JJ) = RX(II,JJ) ENDDO ENDDO * Calcul de la derivee: R,w = dR/dw * Cas Granger-Paidoussis : R,w = R,w - dFf/dw DO J = 1,IPALA(/1) IF (IPALA(J,1).EQ.5 .AND. IPALA(J,3).EQ.101) THEN VCTCS(4) = VV ENDIF ENDDO c Cas d'un balourd : force en OMEG**2 a deriver aussi IF (BAL.EQ.1) THEN DO I=1,NT Rw(I) = Rw(I) - TWO*OMEG*FEXA(I) ENDDO ENDIF DO KK = 1,NT Ja(KK,NT+1) = Rw(KK) Ja(NT+1,KK) = dX(KK) ctest -> nechange rien : Ja(NT+1,KK) = DS*dX(KK) ctest Ja(NT+1,KK) = (Q1(KK)-QOLD(KK)) cdebug c if(OMEG.gt.0.153.and.OMEG.lt.0.170) c & write(*,123) KK,(Ja(KK,iou),iou=1,6),RHS(KK) ENDDO Ja(NT+1,NT+1) = dw ctest -> nechange rien : Ja(NT+1,NT+1) = DS*dw ctest Ja(NT+1,NT+1) = OMEG-OMEGOLD c if(OMEG.gt.0.153.and.OMEG.lt.0.170) c & write(*,123) NT+1,(Ja(NT+1,iou),iou=1,6),RHS(NT+1) * Appel a "DGESV" (LAPACK) DO MM = 1,NT c Q1(MM) = Q1(MM) - RELAX*RHS(MM) Q1(MM) = Q1(MM) - RHS(MM) ENDDO c OMEG = OMEG - RELAX*RHS(NT+1) OMEG = OMEG - RHS(NT+1) c Si on souhaite verifier la convergence en correction dX c res=dnrm2(NT,RHS,1)/dnrm2(NT,Q1,1) c* write(*,*) 'W,Q1=',OMEG,(Q1(iou),iou=1,NT) ENDIF * ----- CAS 3: INITIALISATION (systeme autonome) -------------- IF (TYPC.EQ.'IA') THEN * Calcul de la correction dY, telle que: Ja*dY = -[R;g] * avec: Ja = [Rx Rw; gx 0] DO JJ = 1,NT DO II=1,NT Ja(II,JJ) = RX(II,JJ) ENDDO ENDDO VV = VCTCS(4) * Calcul de la derivee: Rw = dR/dw * cas Granger-Paidoussis : R,w = R,w - dFf/dw DO J = 1,IPALA(/1) IF (IPALA(J,1).EQ.5 .AND. IPALA(J,3).EQ.101) THEN ENDIF ENDDO DO KK = 1,NT Ja(KK,NT+1) = Rw(KK) ENDDO * Condition de phase * On impose une vitesse nulle au 1er DDL en t = 0: * dx1(0) = 0 ==> sum_i{i*Q1_si} = 0 DO I = 1,NT+1 ENDDO DO JJ = 2,2*NHBM,2 Ja(NT+1,JJ*NDDL+1) = JJ/TWO * RHS(NT+1) = RHS(NT+1) + (JJ/TWO)*Q1(JJ*NDDL+1) ENDDO c si on souhaite verifier la convergence en correction dX c res=dnrm2(NT,RHS,1) * Appel a "DGESV" (LAPACK) DO M = 1,NT Q1(M) = Q1(M)-RHS(M) ENDDO OMEG = OMEG-RHS(NT+1) * cas Granger-Paidoussis : rajouter raideur de couplage DO J = 1,IPALA(/1) IF (IPALA(J,1).EQ.5 .AND. IPALA(J,3).EQ.101) THEN ENDIF ENDDO ENDIF * ----- CAS 4: CONTINUATION (systeme autonome) ----------------- IF (TYPC.EQ.'CA') THEN * Calcul de la correction dY, telle que: Jaa*dY = -[R;g;0] * avec Jaa la Jacobienne augmentee: Jaa ={RX,Rw,Ra;gx,0,0;dX,dw,da} DO JJ = 1,NT DO II=1,NT Jaa(II,JJ) = RX(II,JJ) ENDDO ENDDO * Calcul de la derivee: Rw = dR/dw * cas Granger-Paidoussis : R,w = R,w - dFf/dw DO J = 1,IPALA(/1) IF (IPALA(J,1).EQ.5 .AND. IPALA(J,3).EQ.101) THEN VCTCS(4) = VV ENDIF ENDDO DO I = 1,NT+2 ENDDO * Calcul de la derivee : R,Vmoy = dR/dVmoy DO KK = 1,NT Jaa(KK,NT+1) = Rw(KK) Jaa(KK,NT+2) = Ra(KK) Jaa(NT+2,KK) = dX(KK) ENDDO Jaa(NT+2,NT+1) = dw Jaa(NT+2,NT+2) = dv * Condition de phase * On impose une vitesse nulle au 1er DDL en t = 0: * dx1(0) = 0 ==> g(Q) = sum_i{i*Q1_si} = 0 * dg/dw * dg/dv DO JJ = 2,2*NHBM,2 Jaa(NT+1,JJ*NDDL+1) = JJ/2 RHS2(NT+1) = RHS2(NT+1) + (JJ/2)*Q1(JJ*NDDL+1) ENDDO c* WRITE(*,*) 'RHS2=',(RHS2(IOU),IOU=1,NT+2) * STOP * Appel a "DGESV" (LAPACK) c si on souhaite verifier la convergence en correction dX c res=dnrm2(NT+1,RHS2,1) c* WRITE(*,*) 'res=',res c* WRITE(*,*) 'RHS2=',(RHS2(IOU),IOU=1,NT+2) DO M = 1,NT Q1(M) = Q1(M)-RHS2(M) ENDDO OMEG = OMEG-RHS2(NT+1) VV = VV -RHS2(NT+2) DO J = 1,IPALA(/1) IF (IPALA(J,3).EQ.101) THEN VCTCS(4) = VV XPALA(J,4) = VV ENDIF ENDDO ENDIF * ----- CAS 5: INITIALISATION (systeme Hamiltonien) -------------- IF (TYPC.EQ.'IN') THEN * Calcul de la correction dY, telle que: Ja*dY = -[R;g] * avec: Ja = [Rx Rw; gx 0] DO JJ = 1,NT DO II=1,NT Ja(II,JJ) = RX(II,JJ) ENDDO ENDDO * Calcul de la derivee: Rw = dR/dw DO KK = 1,NT Ja(KK,NT+1) = Rw(KK) ENDDO * Condition d'energie * On initialise en imposant un certain niveau d'energie, * i.e. on fixe la norme de Q1 cbp <=> RHS(NT+1) = -0.5*(DDOT(NT,Q1,1,Q1,1)) c car XPARA=DDOT(Q1)=sqrt(Energie_initiale) dans hbmalo cbp : incoherence avec calcul energie realise dans hbmco3 c RHS(NT+1) = DDOT(NT,Q1,1,Q1,1)-XPARA**2 DO I = 1,NT Ja(NT+1,I) = Q1(I) ENDDO c si on souhaite verifier la convergence en correction dX * CALL COPYMAT(NT+1,Ja,J2) * Appel a "DGESV" (LAPACK) DO M = 1,NT Q1(M) = Q1(M)-RHS(M) ENDDO OMEG = OMEG-RHS(NT+1) ENDIF * ----- CAS 6: CONTINUATION (systeme Hamiltonien) ----------------- IF (TYPC.EQ.'CN') THEN * Calcul de la correction dY, telle que: Jaa*dY = -[R;g;0] * avec Jaa la Jacobienne augmentee: * Jaa ={RX,Rw,Ra;gx,0,0;dX,dw,0} * Ici, 'a' est un parametre artificiel qui ferme le probleme * initialement sous-contraint. DO JJ = 1,NT DO II=1,NT Jaa(II,JJ) = RX(II,JJ) ENDDO ENDDO * Calcul de la derivee: Rw = dR/dw * Calcul de la derivee : Ra= (LoI)*X DO KK = 1,NT Jaa(KK,NT+1) = Rw(KK) Jaa(KK,NT+2) = Ra(KK) Jaa(NT+2,KK) = dX(KK) ENDDO Jaa(NT+2,NT+1) = dw * Condition de phase * On minimise la variation de phase entre deux pas succesifs * (condition integrale) * dg/dw * dg/da DO JJ = 1,NT Jaa(NT+1,JJ) = gx(JJ) ENDDO * RHS2(NT+1) = ZERO * RHS2(NT+2) = ZERO * WRITE(*,*) 'RHS2=',(RHS2(IOU),IOU=1,NT+2) * STOP * Appel a "DGESV" (LAPACK) c si on souhaite verifier la convergence en correction dX * res=dnrm2(NT+2,RHS2,1) c WRITE(*,*) 'res=',res * WRITE(*,*) 'RHS2=',(RHS2(IOU),IOU=1,NT+2) DO M = 1,NT Q1(M) = Q1(M)-RHS2(M) ENDDO OMEG = OMEG-RHS2(NT+1) ENDIF * ----- EVALUATION DU RESIDU ----------------------------------- & MTLIAB,MTPAS,MTFEX,LOCLFA,LOCLB1,JANAL2,fvec,fref,NNM) * residu relatif (calcule autrement dans le cas NNM) c* IF (TYPC(2:2).NE.'N') THEN IF (.NOT. NNM) THEN ENDIF IF (IIMPI.GE.2) THEN c IF (IIMPI.GE.333) THEN c WRITE(IOIMP,111) 'Q^',its,(Q1(iou),iou=1,NT) c WRITE(IOIMP,111) 'R^',its,(fvec.prog(iou),iou=1,NT) c ENDIF WRITE(IOIMP,999) its,OMEG,Q1NRM2,res ENDIF * ----- TEST DE CONVERGENCE ------------------------------------ ITER = its IF (res.LE.TOLMIN) THEN check=.FALSE. c Calcul de la Jacobienne pour la solution convergee DO J = 1,IPALA(/1) IF (IPALA(J,1).EQ.5 .AND. IPALA(J,3).EQ.101) THEN VCTCS(4) = VV XPALA(J,4) = VV ENDIF ENDDO DO J=1,NT DO I=1,NT RX(I,J) = ZZ(I,J) - JAC(I,J) ENDDO ENDDO KTQ = MTQ KTEMP=MTEMP RETURN ELSE check = .true. ENDIF ENDDO *====== FIN DES ITERATIONS ============================================= * Menage : SEGSUP,mwrkl,fvec *======================================================================= * Mise en forme des messages *======================================================================= 990 FORMAT(' + newt : ',I3,' w=',F9.5,' |Q|=',F9.5,' |R|=',E10.3, & ' |ref|=',E10.3,' ds=',F9.5) 999 FORMAT(' + newt : ',I3,' w=',F9.5,' |Q|=',F9.5,' |R|=',E10.3) cdebug RETURN END
© Cast3M 2003 - Tous droits réservés.
Mentions légales