smortho3.F File Reference

#include "implicit_f.inc"
#include "mvsiz_p.inc"

Go to the source code of this file.

Functions/Subroutines
subroutine	smortho3 (off, rx, ry, rz, sx, sy, sz, tx, ty, tz, e1x, e2x, e3x, e1y, e2y, e3y, e1z, e2z, e3z, nel)

Function/Subroutine Documentation

smortho3()

subroutine smortho3	(	intent(in)	off,
		intent(in)	rx,
		intent(in)	ry,
		intent(in)	rz,
		intent(in)	sx,
		intent(in)	sy,
		intent(in)	sz,
		intent(in)	tx,
		intent(in)	ty,
		intent(in)	tz,
		intent(out)	e1x,
		intent(out)	e2x,
		intent(out)	e3x,
		intent(out)	e1y,
		intent(out)	e2y,
		intent(out)	e3y,
		intent(out)	e1z,
		intent(out)	e2z,
		intent(out)	e3z,
		integer, intent(in)	nel )

Definition at line 29 of file smortho3.F.

C-----------------------------------------------
C   I m p l i c i t   T y p e s
C-----------------------------------------------
#include      "implicit_f.inc"
C-----------------------------------------------
C   G l o b a l   P a r a m e t e r s
C-----------------------------------------------
#include      "mvsiz_p.inc"
C-----------------------------------------------
C   D u m m y   A r g u m e n t s
C-----------------------------------------------
      INTEGER, INTENT(IN) :: NEL
C     REAL
      my_real, DIMENSION(MVSIZ), INTENT(IN)  ::
     .   rx, ry, rz, sx, sy, sz, tx, ty, tz,off
      my_real, DIMENSION(MVSIZ), INTENT(OUT) ::
     .   e1x, e1y, e1z, e2x, e2y, e2z, e3x, e3y, e3z
C-----------------------------------------------
C   C o m m o n   B l o c k s
C-----------------------------------------------
C-----------------------------------------------
C   L o c a l   V a r i a b l e s
C-----------------------------------------------
      INTEGER I,N,NITER
C     REAL
      my_real
     .   aa,bb
      my_real, DIMENSION(MVSIZ) ::
     .   ux, uy, uz, vx, vy, vz, wx, wy, wz
      DATA niter/3/
C=======================================================================
c     norme r s t
c~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~
      DO i=1,nel
       IF (off(i) <= one ) cycle 
       aa = sqrt(rx(i)*rx(i) + ry(i)*ry(i) + rz(i)*rz(i))
       if ( aa/=zero) aa = one / aa
       ux(i) = rx(i) * aa
       uy(i) = ry(i) * aa
       uz(i) = rz(i) * aa
       aa = sqrt(sx(i)*sx(i) + sy(i)*sy(i) + sz(i)*sz(i))
       if ( aa/=zero) aa = one / aa
       vx(i) = sx(i) * aa
       vy(i) = sy(i) * aa
       vz(i) = sz(i) * aa
       aa = sqrt(tx(i)*tx(i) + ty(i)*ty(i) + tz(i)*tz(i))
       if ( aa/=zero) aa = one / aa
       wx(i) = tx(i) * aa
       wy(i) = ty(i) * aa
       wz(i) = tz(i) * aa
      END DO
c~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~
c     iterations
c~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~
      n=0
111   CONTINUE
      n=n+1
c~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~
      DO i=1,nel
       IF (off(i) <= one ) cycle 
       e1x(i) = vy(i) * wz(i) - vz(i) * wy(i) + ux(i)
       e1y(i) = vz(i) * wx(i) - vx(i) * wz(i) + uy(i)
       e1z(i) = vx(i) * wy(i) - vy(i) * wx(i) + uz(i)
c
       e2x(i) = wy(i) * uz(i) - wz(i) * uy(i) + vx(i)
       e2y(i) = wz(i) * ux(i) - wx(i) * uz(i) + vy(i)
       e2z(i) = wx(i) * uy(i) - wy(i) * ux(i) + vz(i)
c
       e3x(i) = uy(i) * vz(i) - uz(i) * vy(i) + wx(i)
       e3y(i) = uz(i) * vx(i) - ux(i) * vz(i) + wy(i)
       e3z(i) = ux(i) * vy(i) - uy(i) * vx(i) + wz(i)
c
       bb = sqrt(e1x(i)*e1x(i) + e1y(i)*e1y(i) + e1z(i)*e1z(i))
       if ( bb/=zero) bb = one / bb
       ux(i) = e1x(i) * bb
       uy(i) = e1y(i) * bb
       uz(i) = e1z(i) * bb
c
       bb = sqrt(e2x(i)*e2x(i) + e2y(i)*e2y(i) + e2z(i)*e2z(i))
       if ( bb/=zero) bb = one / bb
       vx(i) = e2x(i) * bb
       vy(i) = e2y(i) * bb
       vz(i) = e2z(i) * bb
c
       bb = sqrt(e3x(i)*e3x(i) + e3y(i)*e3y(i) + e3z(i)*e3z(i))
       if ( bb/=zero) bb = one / bb
       wx(i) = e3x(i) * bb
       wy(i) = e3y(i) * bb
       wz(i) = e3z(i) * bb
c
      END DO
      IF (n < niter) GOTO 111
c     norme et orthogonalisation
c~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~
      DO i=1,nel
      IF (off(i) <= one ) cycle 
      e1x(i) = ux(i)
      e1y(i) = uy(i)
      e1z(i) = uz(i)
c
      e3x(i) = e1y(i) * vz(i) - e1z(i) * vy(i)
      e3y(i) = e1z(i) * vx(i) - e1x(i) * vz(i)
      e3z(i) = e1x(i) * vy(i) - e1y(i) * vx(i)
c
      aa = sqrt(e3x(i)*e3x(i) + e3y(i)*e3y(i) + e3z(i)*e3z(i))
      if ( aa/=zero) aa = one / aa
      e3x(i) = e3x(i) * aa
      e3y(i) = e3y(i) * aa
      e3z(i) = e3z(i) * aa
c
      e2x(i) = e3y(i) * e1z(i) - e3z(i) * e1y(i)
      e2y(i) = e3z(i) * e1x(i) - e3x(i) * e1z(i)
      e2z(i) = e3x(i) * e1y(i) - e3y(i) * e1x(i)
      END DO
c~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~
      RETURN