Sources Esope | Cast3M

rotvec
C ROTVEC    SOURCE    CB215821  26/10/26    21:16:04     12682          
      SUBROUTINE ROTVEC(VECT,OMEG,IDIM,KERRE)
C-----------------------------------------------------------------------
C  ROUTINE DE ROTATION D'UN VECTEUR DANS L'HYPOTHESE DES PETITES
C                       ROTATIONS
C-----------------------------------------------------------------------
C  ENTREE
C  ------     VECT   LE VECTEUR A REACTUALISER ( QUELCONQUE )
C             OMEG   LE VECTEUR ROTATION
C             IDIM   INDICE DE LA DIMENSION  ( 2 OU 3 )
C  SORTIE
C  ------     VECT   LE VECTEUR REACTUALISE ( NORME )
C             KERRE  INDICE D'ERREUR   ( 0 SI TOUT EST OK )
C-----------------------------------------------------------------------
      IMPLICIT INTEGER(I-N)
      IMPLICIT REAL*8(A-H,O-Z)
      DIMENSION VECT(*),U(3),OMEG(*)
C
      KERRE=0
      DO 1 I=1,IDIM
      U(I)=VECT(I)
   1  CONTINUE
C
      IF(IDIM.EQ.3) THEN
      VECT(1)=OMEG(2)*U(3)-OMEG(3)*U(2)+U(1)
      VECT(2)=OMEG(3)*U(1)-OMEG(1)*U(3)+U(2)
      VECT(3)=OMEG(1)*U(2)-OMEG(2)*U(1)+U(3)
C
      ELSE IF (IDIM.EQ.2) THEN
      VECT(1)=-OMEG(1)*U(2)+U(1)
      VECT(2)= OMEG(1)*U(1)+U(2)
      ENDIF
C
      XNOR=0.D0
      DO 2 I=1,IDIM
      XNOR=XNOR+VECT(I)*VECT(I)
 2    CONTINUE
      IF(XNOR.EQ.0.D0) THEN
      KERRE=3
      RETURN
      ENDIF
      XNOR=1.D0/SQRT(XNOR)
      DO 3 I=1,IDIM
      VECT(I)=VECT(I)*XNOR
   3  CONTINUE
      RETURN
      END