sensor_dist_surf.F File Reference

#include "implicit_f.inc"
#include "comlock.inc"
#include "units_c.inc"
#include "com04_c.inc"
#include "com08_c.inc"
#include "task_c.inc"
#include "lockon.inc"
#include "lockoff.inc"

Go to the source code of this file.

Functions/Subroutines
subroutine	sensor_dist_surf (sensor, x, igrsurf)

Function/Subroutine Documentation

sensor_dist_surf()

subroutine sensor_dist_surf	(	type (sensor_str_)	sensor,
		dimension(3,numnod)	x,
		type (surf_), dimension(nsurf), target	igrsurf )

Definition at line 33 of file sensor_dist_surf.F.

!$COMMENT
!       SENSOR_DIST_SURF description
!       computation of distance to surface for sensor typ16 + plane defined by 3 nodes
!       and modification of the state of sensor
!       For the other surface, the distance computation is done in SENSOR_DIST_SURF0 routine
!       
!       SENSOR_DIST_SURF0 organization :
!       - computation of local distance for sensor 16 + plane defined by 3 nodes
!       - sensor state modification
!$ENDCOMMENT
c-----------------------------------------------
C   M o d u l e s
c-----------------------------------------------
      USE groupdef_mod
      USE sensor_mod
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   C o m m o n   B l o c k s
C-----------------------------------------------
#include      "units_c.inc"
#include      "com04_c.inc"
#include      "com08_c.inc"
#include      "task_c.inc"
C-----------------------------------------------
C   D u m m y   A r g u m e n t s
C-----------------------------------------------
      my_real ,DIMENSION(3,NUMNOD) :: x
      TYPE (SURF_) ,DIMENSION(NSURF), TARGET :: IGRSURF
      TYPE (SENSOR_STR_) :: SENSOR
C----------------------------------------------------------
C Local Variables
C----------------------------------------------------------
       INTEGER I,ISURF,INOD,NP1,NP2,NP3,NP4,NSEG,ICRIT,IFLAG
       my_real dist,dmin,dmax,alpha,tdelay,tmin
       my_real xnod,ynod,znod,xp1,yp1,zp1,xp2,yp2,zp2,xp3,yp3,zp3,
     .    xp4,yp4,zp4,norm,infinity
      TYPE (SURF_) ,POINTER :: SURFACE
      parameter(infinity = 1.0e20)
C=======================================================================
      IF (sensor%STATUS == 1) RETURN   ! already activated
 
C.....................................................
C ==> DIST between node and a plan defined by 3 nodes
C.....................................................
C     ID_N1 : Node identifier
C     ID_PN1 : Plan Node 1 identifier
C     ID_PN2 : Plan Node 2 identifier
C     ID_PN3 : Plan Node 3 identifier
C
      tmin   = sensor%TMIN
      tdelay = sensor%TDELAY      ! time delay before activation
      inod   = sensor%IPARAM(1)
      isurf  = sensor%IPARAM(2)
c
      dmin   = sensor%RPARAM(1)
      dmax   = sensor%RPARAM(2)
      icrit  = 0
      iflag  = 0
c
c...  Current position of reference node
c
      xnod  = x(1,inod)
      ynod  = x(2,inod)
      znod  = x(3,inod)
c    
c
      IF (isurf == 0) THEN  ! calculate distance to plane defined by 3 nodes
c
        np1 = sensor%IPARAM(3)
        np2 = sensor%IPARAM(4)
        np3 = sensor%IPARAM(5)
        xp1 = x(1,np1)
        yp1 = x(2,np1)
        zp1 = x(3,np1)
        xp2 = x(1,np2)
        yp2 = x(2,np2)
        zp2 = x(3,np2)
        xp3 = x(1,np3)
        yp3 = x(2,np3)
        zp3 = x(3,np3)
        CALL dist_node_plane_3n(dist,
     .       xnod,ynod,znod,xp1,yp1,zp1,xp2,yp2,zp2,xp3,yp3,zp3)
c
        sensor%VALUE = dist
      END IF
      IF (sensor%VALUE <= dmin) THEN
        icrit = 1
        iflag = 1
      ELSE IF (sensor%VALUE >= dmax) THEN
        icrit = 1
        iflag = 2
      END IF
      sensor%RESULTS(1) = sensor%VALUE
c----------------------------------------------------------------
c     check activation status
c----------------------------------------------------------------
      IF (sensor%TCRIT + tmin > tt) THEN
        IF (icrit == 0) THEN
          sensor%TCRIT = infinity
        ELSE IF (sensor%TCRIT == infinity) THEN
          sensor%TCRIT = min(sensor%TCRIT, tt)
        END IF
      END IF
      IF (sensor%TSTART == infinity .and. sensor%TCRIT < infinity) THEN
        sensor%TSTART = sensor%TCRIT + tmin + tdelay      
      END IF
      IF (sensor%TSTART <= tt) THEN   ! sensor activation
        sensor%STATUS = 1
      END IF
c----------------------------------------------------------
      IF (sensor%STATUS == 1 .and. ispmd == 0) THEN
#include "lockon.inc"
        WRITE (istdo,1100) sensor%SENS_ID,sensor%TSTART
        WRITE (iout ,1100) sensor%SENS_ID,sensor%TSTART
        IF (iflag == 1) THEN
          WRITE (iout ,1200) dmin,dist
        ELSE IF (iflag == 2) THEN
          WRITE (iout ,1300) dmax,dist
        END IF
#include "lockoff.inc"
      END IF
c-----------------------------------------------------------------------      
1100  FORMAT(' SENSOR NUMBER ',i10,' ,ACTIVATED AT TIME ',1pe12.5)
1200  FORMAT('      TARGET MIN DISTANCE TO PLAN = ',1pe12.5,/
     .       '      CURRENT DISTANCE AFTER TMIN and TDELAY = ',1pe12.5)
1300  FORMAT('      TARGET MAX DISTANCE TO PLAN = ',1pe12.5,/
     .       '      CURRENT DISTANCE AFTER TMIN and TDELAY = ',1pe12.5)
c----------------------------------------------------------
      RETURN