hbmco2
C HBMCO2 SOURCE CB215821 23/01/25 21:15:19 11573 & ,KCPR,KOCLFA,KOCLB1,NHBM,NFFT,KPARNUM,KSORT,SPAS,ITER) *======================================================================= * Continuation par pseudo longueur d'arc * Cas des systemes autonomes *======================================================================= IMPLICIT INTEGER (I-N) IMPLICIT REAL*8 (A-H,O-Z) INTEGER SPAS, IREDU, METSTB LOGICAL CHECK, CHECKBIF LOGICAL ZINIT,ZSTAB CHARACTER*8 FLAG REAL*8 FTEST(4), FTEST0(4) REAL*8 XAUX(NFFT),nrmR REAL*8 VCTCS(7),AiDi(2),Di(2),bi(2) segment mwork REAL*8 XT(NDDL,NFFT), LAMBD(NDDL) ENDSEGMENT -INC SMLREEL -INC PPARAM -INC CCOPTIO *-INC TMDYNC.INC ************************** debut TMDYNC.INC **************************** * TMDYNC : FUTUR INCLUDE POUR LES SEGMENTS DE L'OPERATEUR DYNC * TODO : a extraire dans un include des que stabilise * * Segment des variables generalisees: * ----------------------------------- SEGMENT MTQ REAL*8 Q1(NT1) REAL*8 OMEG,XPARA REAL*8 JAC(NT1,NT1),ZZ(NT1,NT1),RX(NT1,NT1) REAL*8 dX(NT1), dw, dv ENDSEGMENT * Q1 : vecteur des inconnues frequentielles de dimension (2h+1)*n * Q1 = {q_0 q_c1 q_s1 ... q_sh} * avec q_i vecteur de dimension n ou n=nombre de modes * OMEG : frequence fondamentale de l'approximation * XPARA: parametre de continuation (par defaut la frequence) * \in [PARINI,PARFIN] * RX : matrice jacobienne = ZZ + dFnl/dX * JAC : jacobienne des efforts non-lineaires = dFnl/dX * ZZ : matrice dynamique associee aux matrices modales K, M et C * lineaires et constantes * {dX,dw,(dv)} : vecteur tangent utilise pour la prediction * * * Segment contenant les matrices XK, XASM et XM: * --------------------------------------------- SEGMENT MTKAM REAL*8 XK(NA1,NB1K),XASM(NA1,NB1C),XM(NA1,NB1M) REAL*8 GAM(NPC1,nl1),IGAM(nl1,NPC1),DL(nl1) * REAL*8 GAMFIN(NPC2,nl1) ENDSEGMENT * XK,XASM et XM : matrices de raideur, amortissement et masse * GAM et IGAM : matrices pour la FFT et son inverse * GAMFIN : * * Segment des deformees modales: * ------------------------------ * (idem DYNE) SEGMENT MTPHI INTEGER IBASB(NPLB),IPLSB(NPLB),INMSB(NSB),IORSB(NSB) INTEGER IAROTA(NSB) REAL*8 XPHILB(NSB,NPLSB,NA2,IDIMB) ENDSEGMENT * * Segment descriptif des liaisons en base A: * ------------------------------------------ * (idem DYNE) SEGMENT MTLIAA INTEGER IPALA(NLIAA,NIPALA),IPLIA(NLIAA,NPLAA),JPLIA(NPLA) REAL*8 XPALA(NLIAA,NXPALA) ENDSEGMENT * * Segment descriptif des liaisons en base B: * ------------------------------------------ * (idem DYNE) SEGMENT MTLIAB INTEGER IPALB(NLIAB,NIPALB),IPLIB(NLIAB,NPLBB),JPLIB(NPLB) REAL*8 XPALB(NLIAB,NXPALB) REAL*8 XABSCI(NLIAB,NIP),XORDON(NLIAB,NIP) ENDSEGMENT * * Segment representant les chargements exterieurs: * ----------------------------------------------- SEGMENT MTFEX REAL*8 FEXA(NT1) REAL*8 FEXPSM(NPLB,NPC1,2,IDIMB) INTEGER BAL ENDSEGMENT * FEXA : Vecteur des efforts ext. sous la forme de coefficients de * Fourier et exprimes en base A * FEXPSM: chargement/deplacement statique lie aux modes negliges * (neglige aussi les Fnl). Dans DYNC toujours =0, cree pour * compatibilite avec calcul des Fnl. * BAL : indique s'il s'agit d'un chargement de type balourd * (cad proportionnel a OMEG**2) * * Segment "local" pour DEVLFA: * ---------------------------- SEGMENT LOCLFA REAL*8 FTEST(NA1,4) ENDSEGMENT * * Segment "local" pour DEVLB1: * ---------------------------- SEGMENT LOCLB1 REAL*8 FTEST2(NPLB,6) ENDSEGMENT * * Segment contenant les variables au cours d un pas de temps: * ---------------------------------------------------------- SEGMENT MTPAS REAL*8 FTOTA(NA1,4),FTOTB(NPLB,IDIMB),FTOTBA(NA1) REAL*8 XPTB(NPLB,2,IDIMB),FINERT(NA1,4) REAL*8 XVALA(NLIAA,4,NTVAR),XVALB(NLIAB,4,NTVAR) REAL*8 FEXB(NPLB,2,IDIM),XCHPFB(2,NLIAB,4,NPLB) REAL*8 KTOTXA(NA1,NA1),KTOTVA(NA1,NA1) REAL*8 KTOTXB(NPLB,IDIMB,IDIMB), KTOTVB(NPLB,IDIMB,IDIMB) ENDSEGMENT * FTOTA/B/BA : forces sur base A, B et B projetees sur A * XPTB : deplacement du point d'une liaison en base B * XVALA/B : grandeurs de la liaison en base A/B a stocker * FEXB : forces exterieures en base B (a priori uniquement * pour les moments appliques aux rotations rigides ?) * XCHPFB : forces de contact en base B (lorsqu'on considere un * maillage de contact dans certaines liaisons) * KTOTXA/XB/VA/VB : Jacobienne par rapport au deplacement/vitesse en * base A/B (= contributions a dFnl/dX) * * * Segment des points de reference des modes (base A): * -------------------------------------------------- SEGMENT MPREF INTEGER IPOREF(NPREF) ENDSEGMENT * * Segment des points en base B: * ----------------------------- SEGMENT NCPR(NBPTS) * NCRP(#global) = #local dans XPTB (1er indice) * * Segment des parametres numeriques pour la continuation: * ------------------------------------------------------ SEGMENT PARNUM CHARACTER*4 TYPS REAL*8 DS,DSMAX,DSMIN,ANGMIN,ANGMAX,ITERMOY,ISENS,TOLMIN REAL*8 PARINI,PARFIN INTEGER ITERMAX,NBPAS LOGICAL JANAL ENDSEGMENT * * Segment des resultats: * --------------------- SEGMENT PSORT REAL*8 QSAVE(NT1,NPAS),WSAVE(NPAS),LSAVE(2,2*NA1,NPAS) REAL*8 VSAVE(NPAS) LOGICAL ZSAVE(NPAS) CHARACTER*2 TYPBIF(NBIFU) REAL*8 QBIFU(NT1,NBIFU),WBIFU(NBIFU),WBIF2(NBIFU) REAL*8 QPSIR(NT1,NBIFU),QPSII(NT1,NBIFU) INTEGER CBIF ENDSEGMENT * QSAVE(i,j) = Q harmonique i au pas j * VSAVE(j) = parametre de continuation (si non w) au j-eme pas * ZSAVE(j) = stabilite au j-eme pas * LSAVE(1,j) : partie reelle de l'exposant de Floquet * LSAVE(2,j) : partie imaginaire de l'exposant de Floquet * TYPBIF = {LimitPoint, BranchPoint, NeimarkSacker, PeriodDoubling} * QBIFU,WBIFU : vecteur Q et w au point de bifurcation * WBIF2 : partie imaginaire de l'exposant de Floquet * QPSIR,QPSII : vecteur propre au point de bifurcation * Segment des tableaux de travail: * ------------------------------- SEGMENT MTEMP REAL*8 RW(NT1),A,T0(NT1+1),TP(NT1+1),AMPX,AUX REAL*8 T02(NT1+2), TP2(NT1+2) INTEGER IPIV(NT1),IPIV2(NT1+1),IPIV3(NT1+2) REAL*8 res REAL*8 RHS(NT1+1),Ja(NT1+1,NT1+1) REAL*8 QOLD(NT1),OMEGOLD REAL*8 MATJA(NT1+1,NT1+1),Rw2(NT1) REAL*8 Jaa(NT1+2,NT1+2),RHS2(NT1+2),Ra(NT1),VV,VVOLD ENDSEGMENT * Jacobiennes augmentees * Ja : [ RX Rw ; dX dw] * Jaa: [ RX Rw Ra; gx 0 0; dX dw da] * SEGMENT NNNN * REAL*8 IGAM2(nl1,NPC2),DL2(nl1) * ENDSEGMENT *************************** fin TMDYNC.INC ***************************** C Fonctions BLAS/LAPACK * Variables generalisees MTQ = KTQ * Partie lineaire MTKAM = KTKAM * Parametres numeriques PARNUM = KPARNUM * Reste des segments MTPHI = KTPHI MTFEX = KTFEX MTPAS = KTPAS MTLIAA = KTLIAA MTLIAB = KTLIAB LOCLFA = KOCLFA LOCLB1 = KOCLB1 MTEMP = KTEMP * Tableau des resultats PSORT = KSORT * NT = Q1(/1) NDDL = NT/(2*NHBM+1) PDT = 1./NFFT segini,MWORK *======================================================================= *=== INITIALISATION *======================================================================= II=1 * Recuperation des coefficients si modele GP 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 JG = NDDL MLREE1 = IPALA(J,7) SEGACT, MLREE1 DO IJ = 1,JG ENDDO * Nombre de termes fixe, a generaliser si besoin. JG = 2 MLREE2 = IPALA(J,4) MLREE3 = IPALA(J,8) SEGACT, MLREE2,MLREE3 DO IJ = 1,JG ENDDO SEGDES,MLREE1,MLREE2,MLREE3 ENDIF ENDDO VV = VCTCS(4) DO I=1,NT QOLD(I) = Q1(I) ENDDO OMEGOLD = OMEG VVOLD = VV * Derivee du residu par rapport au parametre de continuation: dR/da * ATTENTION: * L'appel direct a calcRv est a remplacer par l'appel a une sous- * routine qui distingue selon les differentes possibilites associees * a chaque liaison. DO I = 1,NT RHS(I) = Ra(I) ENDDO * DO I = 1,NT+1 * WRITE(*,*) 'Ja(',I,',:)=',(Ja(I,IOU),IOU=1,NT+1) * ENDDO * CALL COPYMAT(NT+1,Ja,J2) * WRITE(*,*) 'RHS=',(RHS(IOU),IOU=1,NT+1) * WRITE(*,*) 'INFO=',INFO * WRITE(*,*) 'pasT=',(RHS(IOU),IOU=1,NT+1) * STOP DO I=1,NT dX(I) = -RHS(I) ENDDO dw = -RHS(NT+1) * WRITE(*,*) 'dX=',(dX(IOU),IOU=1,NT) dv = ONE/sqrt(a**2+dw**2+ONE) * WRITE(*,*) 'dw=',dw * WRITE(*,*) 'dv=',dv dv = -dv ENDIF t02(NT+2)=dv DO J=1,NT dX(J) = dX(J)*dv t02(J) = dX(J) ENDDO dw = dw*dv t02(NT+1) = dw * WRITE(*,*) 't0 = ', (t02(IOU),IOU=1,NT+2) * STOP * Sauvegarde des donnees de sortie DO I=1,NT QSAVE(I,II)=Q1(I) ENDDO WSAVE(II)=OMEG VSAVE(II)= VV ZSAVE(II)= .TRUE. * Message relatif au pas #0 (solution initiale) IF(IIMPI.GE.1) THEN WRITE(IOIMP,*) '+------+------+---------+---------+------+' WRITE(IOIMP,*) '| Pas | Iter | w | Q | Stab |' WRITE(IOIMP,*) '+------+------+---------+---------+------+' WRITE(IOIMP,666) (II-1),ITER,VV,Q1NRM2,ZSAVE(II) ENDIF 666 FORMAT(' | ',I4,' | ',I4,' | ',F7.3,' | ',F7.3,' | ',L3,' |') *======================================================================= * 1ere prediction *======================================================================= OMEG = OMEG + DS*dw DO J=1,NT Q1(J) = Q1(J)+DS*dX(J) ENDDO VV = VV + DS*dv IREDU = 0 II = 2 *======================================================================= *=============== Boucle sur le parametre de continuation =============== *======================================================================= DO WHILE (II .LE. NBPAS) * === Correction ================================================= & MTLIAA,MTLIAB,MTFEX,MTPAS,LOCLFA,LOCLB1,CHECK,'CA',ITER) * ----------------------------- * ---- si NEWT a converge, ---- * ----------------------------- IF (.NOT.CHECK) THEN * Sauvegarde des donnees de sortie: * Frequence, coeffs de Fourier, Norme des coeffs de Fourier * et parametre de continuation DO I=1,NT QSAVE(I,II)=Q1(I) ENDDO WSAVE(II)=OMEG VSAVE(II)=VV ZSAVE(II)= .TRUE. * * === Prediction ============================================== * Pas tangent a la courbe DO J = 1,IPALA(/1) IF (IPALA(J,1).EQ.5 .AND. IPALA(J,3).EQ.101) THEN VCTCS(4) = VV ENDIF ENDDO DO KK= 1,NT DO JJ = 1,NT Ja(JJ,KK) = RX(JJ,KK) ENDDO Ja(KK,NT+1) = Rw(KK) ENDDO DO JJ = 2,2*NHBM,2 Ja(NT+1,JJ*NDDL+1) = JJ/TWO ENDDO DO I = 1,NT RHS(I) = Ra(I) ENDDO DO J=1,NT dX(J) = -RHS(J) tp2(J) = dX(J) ENDDO dw = -RHS(NT+1) tp2(NT+1) = dw tp2(NT+2) = ONE dv = ONE/sqrt(ONE+a**2+dw**2) IF (II.EQ.2) THEN dv = -dv ENDIF ELSE dv = (SIGN(dv,aux)) ENDIF DO K = 1,NT dX(K) = dX(K)*dv tp2(K) = dX(K) ENDDO dw = dw*dv tp2(NT+1) = dw tp2(NT+2) = dv * === Message relatif au pas #II ========== IF(IIMPI.GE.1) THEN WRITE(IOIMP,666) (II-1),ITER,VV,Q1NRM2,.true. ENDIF * * === Tests d'arret =========================================== * On verifie la condition d'arret par rapport a VV c IF ((VV.GT.PARFIN).OR.(VV.LT.PARINI)) THEN IF ((VV-PARFIN)*(PARFIN-PARINI).GE.0) THEN WRITE(IOIMP,*) 'Fin de la continuation apres',II,' pas.' IF (II.LT.NBPAS) THEN * WRITE(*,*) 'NPAS sera egal a:',II NT1 = QSAVE(/1) NA1 = LSAVE(/2)/2 * NPAS = QSAVE(/2) NBIFU = QBIFU(/1) * write(*,*) NT1,NA1,NPAS,NBIFU NPAS = II SEGADJ, PSORT ENDIF KSORT = PSORT RETURN ENDIF * === pour le prochain pas, =================================== * ajustement automatique de la longueur du pas & t02,tp2) * donnees utiles DO I=1,NT+2 t02(I) = tp2(I) ENDDO DO KK = 1,NT QOLD(KK) = Q1(KK)+DS*dX(KK)/FOUR Q1(KK) = Q1(KK)+DS*dX(KK) ENDDO OMEGOLD = OMEG + DS*dw/FOUR VVOLD = VV + DS*dv/FOUR OMEG = OMEG + DS*dw VV = VV + DS*dv IREDU = 0 * ----------------------------------- * ---- si NEWT n'a pas converge, ---- * ----------------------------------- ELSE * Revenir en arriere, en diminuant le pas IF (II.GT.1) THEN DO I=1,NT Q1(I) = QOLD(I) ENDDO OMEG = OMEGOLD VV = VVOLD DS = DS/FOUR II = II-1 ENDIF c apres reduction de 0.25**10 = 1.E-6 , echec ! c 0.25**5 = 1.E-3 c IF (IREDU.GT.10) THEN IF (IREDU.GT.5) THEN WRITE(IOIMP,*)'Non-convergence apres ',IREDU,' reductions' IF (II.LT.NBPAS) THEN NT1 = QSAVE(/1) NA1 = LSAVE(/2)/2 * NPAS = QSAVE(/2) NBIFU = QBIFU(/1) NPAS = II SEGADJ, PSORT ENDIF KSORT = PSORT RETURN ENDIF IREDU = IREDU + 1 IF (IIMPI.GE.3) THEN WRITE(IOIMP,*) 'Reduction du pas #',IREDU ENDIF ENDIF * ---------------------------------------------- * ---- fin distinction NEWT converge ou pas ---- * ---------------------------------------------- * incrementation du compteur II = II+1 ENDDO *======================================================================= * fin de la boucle sur le parametre de continuation *======================================================================= * message WRITE(IOIMP,*) NBPAS, 'pas de continuation realises!' KSORT = PSORT segsup,MWORK END
© Cast3M 2003 - Tous droits réservés.
Mentions légales