sensor_vel.F File Reference

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

Go to the source code of this file.

Functions/Subroutines
subroutine	sensor_vel (sensor, v)

Function/Subroutine Documentation

sensor_vel()

subroutine sensor_vel	(	type (sensor_str_), intent(inout)	sensor,
		dimension(3,numnod)	v )

Definition at line 33 of file sensor_vel.F.

C-----------------------------------------------
C   M o d u l e s
C-----------------------------------------------
      USE sensor_mod
C-----------------------------------------------
C   I m p l i c i t   T y p e s
C-----------------------------------------------
#include      "implicit_f.inc"
C-----------------------------------------------
C   C o m m o n   B l o c k s
C-----------------------------------------------
#include      "com04_c.inc"
#include      "com08_c.inc"
#include      "units_c.inc"
#include      "comlock.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) :: v
      TYPE (sensor_str_) ,INTENT(INOUT) :: sensor
C----------------------------------------------------------
C Local Variables
C----------------------------------------------------------
      INTEGER NODE,ICRIT
c
      my_real :: vel,vx,vy,vz,vv,vvx,vvy,fvx,fvy,fv,freq,
     .           tmin,tstart,tdelay,infinity
      parameter(infinity = 1.0e20)
C=======================================================================
      IF (sensor%STATUS == 1) RETURN   ! already activated
c
      tstart  = sensor%TSTART
      tdelay = sensor%TDELAY
      node   = sensor%IPARAM(1)
      vel    = sensor%RPARAM(1)
      freq   = sensor%RPARAM(2)
      tmin   = zero
      icrit  = 0
c      
      vx = v(1,node)
      vy = v(2,node)
      vz = v(3,node)
      vv = sqrt(vx*vx+vy*vy+vz*vz)
c
      IF (freq > 0) THEN   ! filtering (Butterworth) 
        vvx = sensor%VAR(1)
        vvy = sensor%VAR(2)
        fvx = sensor%VAR(3)
        fvy = sensor%VAR(4)
c
        CALL butterworth(dt2,freq,vvy,vvx,vv,fvy,fvx,fv)
c
        sensor%VAR(1) = vv  
        sensor%VAR(2) = vvx  
        sensor%VAR(3) = fv  
        sensor%VAR(4) = fvx  
        vv = fv
      ENDIF
      IF (vv > vel) icrit = 1
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 = tt
        END IF
      END IF
      IF (sensor%TCRIT < infinity) tstart = sensor%TCRIT + tmin + tdelay
      IF (tstart <= tt) THEN   ! sensor activation
        sensor%STATUS = 1
        sensor%TSTART = tstart
      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
        WRITE (iout ,1200) vel,vv
#include "lockoff.inc"
      ENDIF
c-----------------------------------------------------------------------      
1100  FORMAT(' SENSOR NUMBER ',i10,' ,ACTIVATED AT TIME ',1pe12.5)
1200  FORMAT('      TARGET VELOCITY = ',1pe12.5,/
     .       '      CURRENT VELOCITY AFTER TDELAY = ',1pe12.5)
c-----------------------------------------------------------------------      
      RETURN