dist_node_plane_3n.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/.
!||====================================================================
!||    dist_node_plane_3n   ../engine/source/tools/sensor/dist_node_plane_3n.F
!||--- called by ------------------------------------------------------
!||    sensor_dist_surf     ../engine/source/tools/sensor/sensor_dist_surf.F
!||====================================================================
        SUBROUTINE dist_node_plane_3n (DIST,
     .             XNOD,YNOD,ZNOD,XP1,YP1,ZP1,XP2,YP2,ZP2,XP3,YP3,ZP3)
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
      END SUBROUTINE