i21norm3.F File Reference

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

Go to the source code of this file.

Functions/Subroutines
subroutine	i21norm3 (x, irectm, nrtm, nmn, msr, nint, nty, noint, nod_normal, xm0)
subroutine	i21rcurv (nrtm, xm0, nod_normal, irect, rcurv, anglm)

Function/Subroutine Documentation

i21norm3()

subroutine i21norm3	(		x,
		integer, dimension(4,*)	irectm,
		integer	nrtm,
		integer	nmn,
		integer, dimension(*)	msr,
		integer	nint,
		integer	nty,
		integer	noint,
			nod_normal,
			xm0 )

Definition at line 28 of file i21norm3.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 NRTM, NINT, NTY, NOINT,NMN
      INTEGER IRECTM(4,*), MSR(*)
C     REAL
      my_real
     .   x(3,*), nod_normal(3,*), xm0(3,*)
C-----------------------------------------------
C   L o c a l   V a r i a b l e s
C-----------------------------------------------
      INTEGER I, J, FIRST, LAST, IRM, I1, I2, I3, I4
      INTEGER IX1(MVSIZ), IX2(MVSIZ), IX3(MVSIZ), IX4(MVSIZ)
C     REAL
      my_real
     .     x0(mvsiz), y0(mvsiz), z0(mvsiz),
     .     x1(mvsiz), x2(mvsiz), x3(mvsiz), x4(mvsiz),
     .     y1(mvsiz), y2(mvsiz), y3(mvsiz), y4(mvsiz),
     .     z1(mvsiz), z2(mvsiz), z3(mvsiz), z4(mvsiz),
     .     x01(mvsiz),  x02(mvsiz),  x03(mvsiz), x04(mvsiz),
     .     y01(mvsiz),  y02(mvsiz),  y03(mvsiz), y04(mvsiz),
     .     z01(mvsiz),  z02(mvsiz),  z03(mvsiz), z04(mvsiz),
     .     xn1(mvsiz),yn1(mvsiz),zn1(mvsiz),
     .     xn2(mvsiz),yn2(mvsiz),zn2(mvsiz),
     .     xn3(mvsiz),yn3(mvsiz),zn3(mvsiz),
     .     xn4(mvsiz),yn4(mvsiz),zn4(mvsiz),
     .     aaa
C--------------------------------------------------------------
      first=1
      last =min(nrtm,mvsiz)
C
 100  CONTINUE
C
      DO i=1,last-first+1
        irm=i+first-1
        ix1(i)=msr(irectm(1,irm))
        ix2(i)=msr(irectm(2,irm))
        ix3(i)=msr(irectm(3,irm))
        ix4(i)=msr(irectm(4,irm))
        x1(i)=x(1,ix1(i))
        y1(i)=x(2,ix1(i))
        z1(i)=x(3,ix1(i))
        x2(i)=x(1,ix2(i))
        y2(i)=x(2,ix2(i))
        z2(i)=x(3,ix2(i))
        x3(i)=x(1,ix3(i))
        y3(i)=x(2,ix3(i))
        z3(i)=x(3,ix3(i))
        x4(i)=x(1,ix4(i))
        y4(i)=x(2,ix4(i))
        z4(i)=x(3,ix4(i))
      END DO
C
      DO i=1,last-first+1
        IF(ix3(i)/=ix4(i))THEN
         x0(i) = fourth*(x1(i)+x2(i)+x3(i)+x4(i))
         y0(i) = fourth*(y1(i)+y2(i)+y3(i)+y4(i))
         z0(i) = fourth*(z1(i)+z2(i)+z3(i)+z4(i)) 
        ELSE
         x0(i) = x3(i)
         y0(i) = y3(i)
         z0(i) = z3(i)
        ENDIF
      END DO
C
      DO i=1,last-first+1
C
        x01(i) = x1(i) - x0(i)
        y01(i) = y1(i) - y0(i)
        z01(i) = z1(i) - z0(i)
C
        x02(i) = x2(i) - x0(i)
        y02(i) = y2(i) - y0(i)
        z02(i) = z2(i) - z0(i)
C
        x03(i) = x3(i) - x0(i)
        y03(i) = y3(i) - y0(i)
        z03(i) = z3(i) - z0(i)
C
        x04(i) = x4(i) - x0(i)
        y04(i) = y4(i) - y0(i)
        z04(i) = z4(i) - z0(i)
C
      ENDDO
C
      DO i=1,last-first+1
C
        xn1(i) = y01(i)*z02(i) - z01(i)*y02(i)
        yn1(i) = z01(i)*x02(i) - x01(i)*z02(i)
        zn1(i) = x01(i)*y02(i) - y01(i)*x02(i)
C
        xn2(i) = y02(i)*z03(i) - z02(i)*y03(i)
        yn2(i) = z02(i)*x03(i) - x02(i)*z03(i)
        zn2(i) = x02(i)*y03(i) - y02(i)*x03(i)
C
        xn3(i) = y03(i)*z04(i) - z03(i)*y04(i)
        yn3(i) = z03(i)*x04(i) - x03(i)*z04(i)
        zn3(i) = x03(i)*y04(i) - y03(i)*x04(i)
C
        xn4(i) = y04(i)*z01(i) - z04(i)*y01(i)
        yn4(i) = z04(i)*x01(i) - x04(i)*z01(i)
        zn4(i) = x04(i)*y01(i) - y04(i)*x01(i)
C
      ENDDO
C
      DO i=1,last-first+1
C
        aaa=one/max(em30,sqrt(xn1(i)*xn1(i)+yn1(i)*yn1(i)+zn1(i)*zn1(i)))
        xn1(i) = xn1(i)*aaa
        yn1(i) = yn1(i)*aaa
        zn1(i) = zn1(i)*aaa
C
        aaa=one/max(em30,sqrt(xn2(i)*xn2(i)+yn2(i)*yn2(i)+zn2(i)*zn2(i)))
        xn2(i) = xn2(i)*aaa
        yn2(i) = yn2(i)*aaa
        zn2(i) = zn2(i)*aaa
C
        aaa=one/max(em30,sqrt(xn3(i)*xn3(i)+yn3(i)*yn3(i)+zn3(i)*zn3(i)))
        xn3(i) = xn3(i)*aaa
        yn3(i) = yn3(i)*aaa
        zn3(i) = zn3(i)*aaa
C
        aaa=one/max(em30,sqrt(xn4(i)*xn4(i)+yn4(i)*yn4(i)+zn4(i)*zn4(i)))
        xn4(i) = xn4(i)*aaa
        yn4(i) = yn4(i)*aaa
        zn4(i) = zn4(i)*aaa
C
      ENDDO
C
      DO i=1,last-first+1
C
        irm=i+first-1
C
        i1=irectm(1,irm)
        i2=irectm(2,irm)
        i3=irectm(3,irm)
        i4=irectm(4,irm)
C
        IF(i4/=i3)THEN
C
          nod_normal(1,i1)=nod_normal(1,i1)+xn4(i)+xn1(i)
          nod_normal(2,i1)=nod_normal(2,i1)+yn4(i)+yn1(i)
          nod_normal(3,i1)=nod_normal(3,i1)+zn4(i)+zn1(i)
C
          nod_normal(1,i2)=nod_normal(1,i2)+xn1(i)+xn2(i)
          nod_normal(2,i2)=nod_normal(2,i2)+yn1(i)+yn2(i)
          nod_normal(3,i2)=nod_normal(3,i2)+zn1(i)+zn2(i)
C
          nod_normal(1,i3)=nod_normal(1,i3)+xn2(i)+xn3(i)
          nod_normal(2,i3)=nod_normal(2,i3)+yn2(i)+yn3(i)
          nod_normal(3,i3)=nod_normal(3,i3)+zn2(i)+zn3(i)
C
          nod_normal(1,i4)=nod_normal(1,i4)+xn3(i)+xn4(i)
          nod_normal(2,i4)=nod_normal(2,i4)+yn3(i)+yn4(i)
          nod_normal(3,i4)=nod_normal(3,i4)+zn3(i)+zn4(i)
C
        ELSE
C
          nod_normal(1,i1)=nod_normal(1,i1)+xn1(i)
          nod_normal(2,i1)=nod_normal(2,i1)+yn1(i)
          nod_normal(3,i1)=nod_normal(3,i1)+zn1(i)
C
          nod_normal(1,i2)=nod_normal(1,i2)+xn1(i)
          nod_normal(2,i2)=nod_normal(2,i2)+yn1(i)
          nod_normal(3,i2)=nod_normal(3,i2)+zn1(i)
C
          nod_normal(1,i3)=nod_normal(1,i3)+xn1(i)
          nod_normal(2,i3)=nod_normal(2,i3)+yn1(i)
          nod_normal(3,i3)=nod_normal(3,i3)+zn1(i)
C
        END IF
C
      ENDDO
C
      IF(last < nrtm)THEN
        first=last+1
        last =min(last+mvsiz,nrtm)
        GO TO 100
      END IF
C------------------------------------
C     normales aux noeuds.
C------------------------------------
      DO i=1,nmn
C
        aaa=one/max(em30,sqrt(nod_normal(1,i)*nod_normal(1,i)+
     .                       nod_normal(2,i)*nod_normal(2,i)+
     .                       nod_normal(3,i)*nod_normal(3,i)))
        nod_normal(1,i)=nod_normal(1,i)*aaa
        nod_normal(2,i)=nod_normal(2,i)*aaa
        nod_normal(3,i)=nod_normal(3,i)*aaa
C
      END DO
C------------------------------------
C     Coordonnees initiales cote main (1: active ; 0: inactive)
C------------------------------------
      DO i=1,nmn
        DO j=1,3
          xm0(j,i)=x(j,msr(i))
        END DO
      END DO
C------------------------------------
      RETURN
 1000 FORMAT(2x,'GAP MIN = ',1pg20.13)

i21rcurv()

subroutine i21rcurv	(	integer	nrtm,
			xm0,
			nod_normal,
		integer, dimension(4,*)	irect,
			rcurv,
			anglm )

Definition at line 248 of file i21norm3.F.

C-----------------------------------------------
C   I m p l i c i t   T y p e s
C-----------------------------------------------
#include      "implicit_f.inc"
C-----------------------------------------------
C   D u m m y   A r g u m e n t s
C-----------------------------------------------
      INTEGER NRTM, IRECT(4,*)
      my_real
     .    xm0(3,*), nod_normal(3,*), rcurv(*), anglm(*)
C-----------------------------------------------
C   L o c a l   V a r i a b l e s
C-----------------------------------------------
      INTEGER I ,N1, N2, N3, N4
      my_real
     .   x1, x2, x3, x4,
     .   y1, y2, y3, y4,
     .   z1, z2, z3, z4,
     .   nnx1, nnx2, nnx3, nnx4,
     .   nny1, nny2, nny3, nny4,
     .   nnz1, nnz2, nnz3, nnz4,
     .   surfx, surfy, surfz, 
     .   erx, ery, erz, dnx, dny, dnz, dnt, ll, aaa, rr,
     .   x13, y13, z13, x24, y24, z24, nx, ny, nz, cc
C-----------------------------------------------
      rcurv(1:nrtm) = ep30
      anglm(1:nrtm) = ep30
 
      DO i=1,nrtm
        n1=irect(1,i)
        n2=irect(2,i)
        n3=irect(3,i)
        n4=irect(4,i)
 
        x1=xm0(1,n1)  
        y1=xm0(2,n1)  
        z1=xm0(3,n1)  
 
        x2=xm0(1,n2)  
        y2=xm0(2,n2)  
        z2=xm0(3,n2)  
 
        x3=xm0(1,n3)  
        y3=xm0(2,n3)  
        z3=xm0(3,n3)  
 
        x4=xm0(1,n4)  
        y4=xm0(2,n4)  
        z4=xm0(3,n4)  
 
        nnx1=nod_normal(1,n1)
        nny1=nod_normal(2,n1)
        nnz1=nod_normal(3,n1)
 
        nnx2=nod_normal(1,n2)
        nny2=nod_normal(2,n2)
        nnz2=nod_normal(3,n2)
 
        nnx3=nod_normal(1,n3)
        nny3=nod_normal(2,n3)
        nnz3=nod_normal(3,n3)
 
        nnx4=nod_normal(1,n4)
        nny4=nod_normal(2,n4)
        nnz4=nod_normal(3,n4)
 
C-------
        erx = (x2+x3)-(x1+x4)
        ery = (y2+y3)-(y1+y4)
        erz = (z2+z3)-(z1+z4)
 
C       Longueur vraie = LL/2
        ll  = sqrt(erx*erx+ery*ery+erz*erz)
        aaa = one / ll
        erx = erx*aaa
        ery = ery*aaa
        erz = erz*aaa
 
        dnx= (nnx2+nnx3)-(nnx1+nnx4)
        dny= (nny2+nny3)-(nny1+nny4)
        dnz= (nnz2+nnz3)-(nnz1+nnz4)
C
C       DN vraie = DNT/2
        dnt=(dnx*erx+dny*ery+dnz*erz)
 
        rr=ll/max(em20,abs(dnt))
        rcurv(i)=min(rcurv(i),rr)
C-------
        erx = (x4+x3)-(x1+x2)
        ery = (y4+y3)-(y1+y2)
        erz = (z4+z3)-(z1+z2)
 
C       Longueur vraie = LL/2
        ll  = sqrt(erx*erx+ery*ery+erz*erz)
        aaa = one / ll
        erx = erx*aaa
        ery = ery*aaa
        erz = erz*aaa
 
        dnx= (nnx4+nnx3)-(nnx1+nnx2)
        dny= (nny4+nny3)-(nny1+nny2)
        dnz= (nnz4+nnz3)-(nnz1+nnz2)
C
C       DN vraie = DNT/2
        dnt=(dnx*erx+dny*ery+dnz*erz)
 
        rr=ll/max(em20,abs(dnt))
        rcurv(i)=min(rcurv(i),rr)
C-------
C-------
C-------
C       Angles.
C-------
        x13 = x3 - x1
        y13 = y3 - y1
        z13 = z3 - z1
 
        x24 = x4 - x2
        y24 = y4 - y2
        z24 = z4 - z2
 
        surfx = y13*z24 - z13*y24
        surfy = z13*x24 - x13*z24
        surfz = x13*y24 - y13*x24
 
        aaa=one/max(em30,sqrt(surfx*surfx+surfy*surfy+surfz*surfz))
        surfx = surfx * aaa
        surfy = surfy * aaa
        surfz = surfz * aaa
 
        cc=(surfx*nnx1+surfy*nny1+surfz*nnz1)
        anglm(i)=min(anglm(i),cc)
 
        cc=(surfx*nnx2+surfy*nny2+surfz*nnz2)
        anglm(i)=min(anglm(i),cc)
 
        cc=(surfx*nnx3+surfy*nny3+surfz*nnz3)
        anglm(i)=min(anglm(i),cc)
 
        cc=(surfx*nnx4+surfy*nny4+surfz*nnz4)
        anglm(i)=min(anglm(i),cc)
      ENDDO
 
      RETURN