dist_node_plane_3n.F File Reference

#include "implicit_f.inc"

Go to the source code of this file.

Functions/Subroutines
subroutine	dist_node_plane_3n (dist, xnod, ynod, znod, xp1, yp1, zp1, xp2, yp2, zp2, xp3, yp3, zp3)

Function/Subroutine Documentation

dist_node_plane_3n()

subroutine dist_node_plane_3n	(	intent(out)	dist,
		intent(in)	xnod,
		intent(in)	ynod,
		intent(in)	znod,
		intent(in)	xp1,
		intent(in)	yp1,
		intent(in)	zp1,
		intent(in)	xp2,
		intent(in)	yp2,
		intent(in)	zp2,
		intent(in)	xp3,
		intent(in)	yp3,
		intent(in)	zp3 )

Definition at line 28 of file dist_node_plane_3n.F.

c-----------------------------------------------------------------------
c Calculates distance between NODE(XNOD,YNOD,ZNOD) 
c and a flat surface defined by three points P1, P2, P3
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-----------------------------------------------
      my_real , INTENT(IN)  :: xnod,ynod,znod,
     .                         xp1,yp1,zp1,xp2,yp2,zp2,xp3,yp3,zp3
      my_real , INTENT(OUT) :: dist
C----------------------------------------------------------
C Local Variables
C----------------------------------------------------------
      my_real :: ax,ay,az,bx,by,bz,vecx,vecy,vecz,nx,ny,nz,norm
C=======================================================================
      ax = xp2 - xp1
      ay = yp2 - yp1
      az = zp2 - zp1
      bx = xp3 - xp1
      by = yp3 - yp1
      bz = zp3 - zp1
      vecx = xnod - xp1 
      vecy = ynod - yp1 
      vecz = znod - zp1 
c
      nx = ay*bz - az*by
      ny = az*bx - ax*bz
      nz = ax*by - ay*bx
      norm = sqrt(nx*nx + ny*ny + nz*nz)
c     distance to plane
      dist = abs(nx*vecx + ny*vecy + nz*vecz) / norm
c-----------
      RETURN