spreploc.F

Go to the documentation of this file.

Copyright>        OpenRadioss
Copyright>        Copyright (C) 1986-2025 Altair Engineering Inc.
Copyright>
Copyright>        This program is free software: you can redistribute it and/or modify
Copyright>        it under the terms of the GNU Affero General Public License as published by
Copyright>        the Free Software Foundation, either version 3 of the License, or
Copyright>        (at your option) any later version.
Copyright>
Copyright>        This program is distributed in the hope that it will be useful,
Copyright>        but WITHOUT ANY WARRANTY; without even the implied warranty of
Copyright>        MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
Copyright>        GNU Affero General Public License for more details.
Copyright>
Copyright>        You should have received a copy of the GNU Affero General Public License
Copyright>        along with this program.  If not, see <https://www.gnu.org/licenses/>.
Copyright>
Copyright>
Copyright>        Commercial Alternative: Altair Radioss Software
Copyright>
Copyright>        As an alternative to this open-source version, Altair also offers Altair Radioss
Copyright>        software under a commercial license.  Contact Altair to discuss further if the
Copyright>        commercial version may interest you: https://www.altair.com/radioss/.
!||====================================================================
!||    spreploc   ../engine/source/elements/sph/spreploc.f
!||--- called by ------------------------------------------------------
!||    spstres    ../engine/source/elements/sph/spstres.F
!||====================================================================
      SUBROUTINE spreploc(
     1   REPLOC,  WXX,     WYY,     WZZ,
     2   GAMA,    NEL,     LFT,     LLT,
     3   ISORTH)
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(INOUT) :: LFT
      INTEGER, INTENT(INOUT) :: LLT
      INTEGER, INTENT(INOUT) :: ISORTH
      INTEGER NEL
C     REAL
      my_real
     .   reploc(nel,6),wxx(*), wyy(*), wzz(*), gama(mvsiz,6)
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, J
C     REAL
      my_real
     .   rx(mvsiz),ry(mvsiz),rz(mvsiz),cr(mvsiz),sr(mvsiz),
     .   nr,ps,ux,uy,uz,vx,vy,vz,wx,wy,wz,tx,ty,tz
C-----------------------------------------------
      IF (isorth == 0) THEN
        DO i=lft,llt
          gama(i,1)=one
          gama(i,2)=zero 
          gama(i,3)=zero 
          gama(i,4)=zero
          gama(i,5)=one 
          gama(i,6)=zero 
        ENDDO
      ELSE
C
        DO i=lft,llt
          nr=sqrt(wxx(i)*wxx(i)+wyy(i)*wyy(i)+wzz(i)*wzz(i))
          cr(i)=one-half*nr*nr
          sr(i)=nr
          nr=one/max(em20,nr)
          rx(i)=wxx(i)*nr
          ry(i)=wyy(i)*nr
          rz(i)=wzz(i)*nr
        ENDDO
C
        DO i=lft,llt
          ux=reploc(i,1)
          uy=reploc(i,2)
          uz=reploc(i,3)
          ps=ux*rx(i)+uy*ry(i)+uz*rz(i)
          vx=ps*rx(i)
          vy=ps*ry(i)
          vz=ps*rz(i)
          wx=ux-vx
          wy=uy-vy
          wz=uz-vz
          tx=ry(i)*wz-rz(i)*wy
          ty=rz(i)*wx-rx(i)*wz
          tz=rx(i)*wy-ry(i)*wx
          ux=vx+cr(i)*wx+sr(i)*tx
          uy=vy+cr(i)*wy+sr(i)*ty
          uz=vz+cr(i)*wz+sr(i)*tz
          nr=one/max(em20,sqrt(ux*ux+uy*uy+uz*uz))
          reploc(i,1)=ux*nr
          reploc(i,2)=uy*nr
          reploc(i,3)=uz*nr
        ENDDO
C
        DO i=lft,llt
          ux=reploc(i,4)
          uy=reploc(i,5)
          uz=reploc(i,6)
          ps=ux*rx(i)+uy*ry(i)+uz*rz(i)
          vx=ps*rx(i)
          vy=ps*ry(i)
          vz=ps*rz(i)
          wx=ux-vx
          wy=uy-vy
          wz=uz-vz
          tx=ry(i)*wz-rz(i)*wy
          ty=rz(i)*wx-rx(i)*wz
          tz=rx(i)*wy-ry(i)*wx
          ux=vx+cr(i)*wx+sr(i)*tx
          uy=vy+cr(i)*wy+sr(i)*ty
          uz=vz+cr(i)*wz+sr(i)*tz
          nr=one/max(em20,sqrt(ux*ux+uy*uy+uz*uz))
          reploc(i,4)=ux*nr
          reploc(i,5)=uy*nr
          reploc(i,6)=uz*nr
        ENDDO
C
        DO i=lft,llt
          gama(i,1)=reploc(i,1)
          gama(i,2)=reploc(i,2)
          gama(i,3)=reploc(i,3)
          gama(i,4)=reploc(i,4)
          gama(i,5)=reploc(i,5)
          gama(i,6)=reploc(i,6)
        ENDDO
C
      ENDIF
C
      RETURN
      END