poupas
C POUPAS SOURCE CHAT 05/01/13 02:19:29 5004 C----------------------------------------------------------------------- C ROUTINE DE CALCUL DE LA MATRICE DE PASSAGE P DES AXES LOCAUX AUX AXES C GLOBAUX : DEPLOC= P * DEPGLO C C ENTREE C XE YE ZE COORDONNEES DES 2 NOEUDS C VECT VECTEUR DEFINISSANT LE REPERE LOCAL DE LA POUTRE C C SORTIE C P MATRICE DE CHANGEMENT DE BASE C KERRE = 0 SI PAS DE PB C = 1 SI POINTS CONFONDUS C = 2 SI LE VECTEUR LOCAL EST COLINEAIRE A L'ELEMENT C C----------------------------------------------------------------------- IMPLICIT INTEGER(I-N) IMPLICIT REAL*8(A-H,O-Z) C KERRE=0 A(1)=XE(2)-XE(1) A(2)=YE(2)-YE(1) A(3)=ZE(2)-ZE(1) XL=SQRT(A(1)**2+A(2)**2+A(3)**2) IF(XL.EQ.0.D0) THEN KERRE=1 RETURN ENDIF RL=1.D00/XL C C----------------------------------------------------------------------- C ON CHOISIT DE DETERMINER ICI LE VECTEUR DEFINISSANT LE C REPERE LOCAL DE LA POUTRE SI IL N A PAS ETE DONNE PAR L UTILISATEUR C----------------------------------------------------------------------- C IDEF=0 C C DEFINITION DU VECTEUR LOCAL PAR DEFAUT ( NON NORME ) C IDEF=1 10 CONTINUE DO 22 I=1,3 22 P(1,I)=A(I)*RL RLP=0. DO 1 I=1,3 RLP= SQRT(RLP) C C TEST DE COLINEARITE C PROD=0.D00 DO 4 I=1,3 IF(ABS(PROD).LT.0.99D00*RLP) GO TO 5 IF(IDEF.EQ.0) GOTO 41 GOTO 5 41 CONTINUE KERRE=2 RETURN C C ORTHOGONALISATION ET REMPLISSAGE DE LA MATRICE P C 5 CONTINUE RLP=0.D00 DO 6 I=1,3 RLP=1.D00/SQRT(RLP) DO 2 I=1,3 P(3,1)= P(1,2)*P(2,3)- P(2,2)*P(1,3) P(3,2)=P(1,3)*P(2,1)-P(1,1)*P(2,3) P(3,3)= P(1,1)*P(2,2)-P(1,2)*P(2,1) RETURN END
© Cast3M 2003 - Tous droits réservés.
Mentions légales