r4cum3p.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/.
!||====================================================================
!||    r4cum3p     ../engine/source/elements/spring/r4cum3p.F
!||--- called by ------------------------------------------------------
!||    r23law113   ../engine/source/elements/spring/r23law113.F
!||    r23law114   ../engine/source/elements/spring/r23law114.F
!||    rforc3      ../engine/source/elements/spring/rforc3.F
!||====================================================================
      SUBROUTINE r4cum3p(
     1   FORX,    FORY,    FORZ,    XMOM,
     2   YMOM,    ZMOM,    STI,     STIR,
     3   FSKY,    FSKYV,   IADR,    FX1,
     4   FX2,     FY1,     FY2,     FZ1,
     5   FZ2,     MX1,     MX2,     MY1,
     6   MY2,     MZ1,     MZ2,     EXX,
     7   EYX,     EZX,     EXY,     EYY,
     8   EZY,     EXZ,     EYZ,     EZZ,
     9   AL,      NEL,     NFT)
C-----------------------------------------------
C   I m p l i c i t   T y p e s
C-----------------------------------------------
#include      "implicit_f.inc"
#include      "comlock.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   C o m m o n   B l o c k s
C-----------------------------------------------
#include      "parit_c.inc"
C-----------------------------------------------
C   D u m m y   A r g u m e n t s
C-----------------------------------------------
      INTEGER, INTENT(IN) :: NEL
      INTEGER, INTENT(IN) :: NFT
      INTEGER IADR(3,*)
C     REAL
      my_real
     .   FORX(*), FORY(*), FORZ(*), XMOM(*),
     .   YMOM(*),ZMOM(*),STI(3,*),STIR(3,*),FSKYV(LSKY,8),
     .   FSKY(8,LSKY),
     .   FX1(MVSIZ),FY1(MVSIZ),FZ1(MVSIZ),
     .   fx2(mvsiz),fy2(mvsiz),fz2(mvsiz),
     .   mx1(mvsiz),my1(mvsiz),mz1(mvsiz),
     .   mx2(mvsiz),my2(mvsiz),mz2(mvsiz),
     .   exx(mvsiz), eyx(mvsiz), ezx(mvsiz),
     .   exy(mvsiz), eyy(mvsiz), ezy(mvsiz),
     .   exz(mvsiz), eyz(mvsiz), ezz(mvsiz),al(mvsiz)
C-----------------------------------------------
C   L o c a l   V a r i a b l e s
C-----------------------------------------------
      INTEGER I, II, N
C     REAL
      my_real
     .   F11(MVSIZ), F21(MVSIZ), F31(MVSIZ), 
     .   M11(MVSIZ), M21(MVSIZ), M31(MVSIZ),
     .   M12(MVSIZ), M22(MVSIZ), M32(MVSIZ),
     . YMOM1, YMOM2, ZMOM1, ZMOM2
C-----------------------------------------------
      DO I=1,nel
        f11(i)=exx(i)*forx(i)+exy(i)*fory(i)+exz(i)*forz(i)
        f21(i)=eyx(i)*forx(i)+eyy(i)*fory(i)+eyz(i)*forz(i)
        f31(i)=ezx(i)*forx(i)+ezy(i)*fory(i)+ezz(i)*forz(i)
      ENDDO
C-------------------------
C     ASSEMBLE
C-------------------------
      IF (ivector == 1) THEN
#include "vectorize.inc"
        DO i=1,nel
          ii = i+nft
          n = iadr(1,ii)
          fskyv(n,1)=f11(i)
          fskyv(n,2)=f21(i)
          fskyv(n,3)=f31(i)
          fx1(i) = -f11(i)
          fy1(i) = -f21(i)
          fz1(i) = -f31(i)
          fskyv(n,7)=sti(1,i)
          n = iadr(2,ii)
          fskyv(n,1)=-f11(i)
          fskyv(n,2)=-f21(i)
          fskyv(n,3)=-f31(i)
          fx2(i) = f11(i)
          fy2(i) = f21(i)
          fz2(i) = f31(i)
          fskyv(n,7)=sti(2,i)
        ENDDO
      ELSE
        DO i=1,nel
         ii = i+nft
         n = iadr(1,ii)
         fsky(1,n)=f11(i)
         fsky(2,n)=f21(i)
         fsky(3,n)=f31(i)
         fx1(i) = -f11(i)
         fy1(i) = -f21(i)
         fz1(i) = -f31(i)
         fsky(7,n)=sti(1,i)
         n = iadr(2,ii)
         fsky(1,n)=-f11(i)
         fsky(2,n)=-f21(i)
         fsky(3,n)=-f31(i)
         fx2(i) = f11(i)
         fy2(i) = f21(i)
         fz2(i) = f31(i)
         fsky(7,n)=sti(2,i)
        ENDDO
      ENDIF
C-------------------------
C     MOMENTS
C-------------------------
      DO i=1,nel
        ymom1 = ymom(i) - half*al(i)*forz(i)
        zmom1 = zmom(i) + half*al(i)*fory(i)
        m11(i)=exx(i)*xmom(i)+exy(i)*ymom1+exz(i)*zmom1
        m21(i)=eyx(i)*xmom(i)+eyy(i)*ymom1+eyz(i)*zmom1
        m31(i)=ezx(i)*xmom(i)+ezy(i)*ymom1+ezz(i)*zmom1
        ymom2 = ymom(i) + half*al(i)*forz(i)
        zmom2 = zmom(i) - half*al(i)*fory(i)
        m12(i)=exx(i)*xmom(i)+exy(i)*ymom2+exz(i)*zmom2
        m22(i)=eyx(i)*xmom(i)+eyy(i)*ymom2+eyz(i)*zmom2
        m32(i)=ezx(i)*xmom(i)+ezy(i)*ymom2+ezz(i)*zmom2
      ENDDO
C-------------------------
C     ASSEMBLE
C-------------------------
      IF (ivector == 1) THEN
#include "vectorize.inc"
        DO i=1,nel
          ii = i+nft
          n = iadr(1,ii)
          fskyv(n,4)=m11(i)
          fskyv(n,5)=m21(i)
          fskyv(n,6)=m31(i)
          mx1(i) = -m11(i)
          my1(i) = -m21(i)
          mz1(i) = -m31(i)
          fskyv(n,8)=stir(1,i)
          n = iadr(2,ii)
          fskyv(n,4)=-m12(i)
          fskyv(n,5)=-m22(i)
          fskyv(n,6)=-m32(i)
          mx2(i) = m12(i)
          my2(i) = m22(i)
          mz2(i) = m32(i)
          fskyv(n,8)=stir(2,i)
        ENDDO
      ELSE
        DO i=1,nel
          ii = i+nft
          n = iadr(1,ii)
          fsky(4,n)=m11(i)
          fsky(5,n)=m21(i)
          fsky(6,n)=m31(i)
          mx1(i) = -m11(i)
          my1(i) = -m21(i)
          mz1(i) = -m31(i)
          fsky(8,n)=stir(1,i)
          n = iadr(2,ii)
          fsky(4,n)=-m12(i)
          fsky(5,n)=-m22(i)
          fsky(6,n)=-m32(i)
          mx2(i) = m12(i)
          my2(i) = m22(i)
          mz2(i) = m32(i)
          fsky(8,n)=stir(2,i)
        ENDDO
      ENDIF
C---
      RETURN
      END