32 . NPRW ,DIMFB ,STABS ,TABS ,FBSAV6)
40#include "implicit_f.inc"
52 INTEGER :: DIMFB,STABS
53 INTEGER :: TABS(STABS),NPRW(*)
54 DOUBLE PRECISION FBSAV6(12,6,DIMFB)
55 TYPE (SENSOR_STR_) ,
TARGET :: SENSOR
59 INTEGER :: RW_ID,IDIR,ICRIT,ISECT,N5,ACTI
60 my_real :: fmin,fmax,ff,fx,fy,fz,tmin,tdelay,tstart,tstops,infinity
61 parameter(infinity = 1.0e20)
64 tdelay = sensor%TDELAY
65 tstart = sensor%TSTART
68 rw_id = sensor%IPARAM(1)
69 idir = sensor%IPARAM(2)
70 fmin = sensor%RPARAM(1)
71 fmax = sensor%RPARAM(2)
79 isect = tabs(nsect+rw_id+1)-tabs(nsect+rw_id)
82 IF (nprw(n5) == 1)
THEN
83 isect = tabs(rw_id+nsect+ninter+nintsub+1)-tabs(rw_id+nsect+ninter+nintsub)
85 fx = fbsav6(1,1,isect)+fbsav6(1,2,isect)+
86 . fbsav6(1,3,isect)+fbsav6(1,4,isect)+
87 . fbsav6(1,5,isect)+fbsav6(1,6,isect)
89 ELSEIF (idir == 2)
THEN
90 fy = fbsav6(2,1,isect)+fbsav6(2,2,isect)+
91 . fbsav6(2,3,isect)+fbsav6(2,4,isect)+
92 . fbsav6(2,5,isect)+fbsav6(2,6,isect)
94 ELSEIF (idir == 4)
THEN
95 fz = fbsav6(3,1,isect)+fbsav6(3,2,isect)+
96 . fbsav6(3,3,isect)+fbsav6(3,4,isect)+
97 . fbsav6(3,5,isect)+fbsav6(3,6,isect)
99 ELSEIF (idir == 5)
THEN
100 fx = fbsav6(1,1,isect)+fbsav6(1,2,isect)+
101 . fbsav6(1,3,isect)+fbsav6(1,4,isect)+
102 . fbsav6(1,5,isect)+fbsav6(1,6,isect)
103 fy = fbsav6(2,1,isect)+fbsav6(2,2,isect)+
104 . fbsav6(2,3,isect)+fbsav6(2,4,isect)+
105 . fbsav6(2,5,isect)+fbsav6(2,6,isect)
106 fz = fbsav6(3,1,isect)+fbsav6(3,2,isect)+
107 . fbsav6(3,3,isect)+fbsav6(3,4,isect)+
108 . fbsav6(3,5,isect)+fbsav6(3,6,isect)
109 ff = sqrt(fx*fx + fy*fy + fz*fz)
110 ELSEIF (idir == 6)
THEN
111 fx = fbsav6(4,1,isect)+fbsav6(4,2,isect)+
112 . fbsav6(4,3,isect)+fbsav6(4,4,isect)+
113 . fbsav6(4,5,isect)+fbsav6(4,6,isect)
117 fz = fbsav6(6,1,isect)+fbsav6(6,2,isect)+
118 . fbsav6(6,3,isect)+fbsav6(6,4,isect)+
119 . fbsav6(6,5,isect)+fbsav6(6,6,isect)
120 ff = sqrt(fx*fx + fy*fy + fz*fz
122 sensor%RESULTS(1) = ff
124 IF (ff < fmin .OR. ff > fmax .OR. idir == 0) icrit = 1
129 sensor%TCRIT =
min(sensor%TCRIT, tt)
131 sensor%TCRIT = infinity
133 IF (sensor%TCRIT + tmin <= tt)
THEN
135 sensor%VALUE = tstops
136 IF (sensor%STATUS == 0)
THEN
144 IF (tt > tstops .AND. sensor%STATUS == 1)
THEN
146 sensor%TSTART = infinity
147 sensor%VALUE = infinity
157 WRITE (istdo,1100) sensor%SENS_ID,sensor%TSTART
159 WRITE (iout ,1200) sensor%SENS_ID,sensor%TSTART,fmin,ff
160 ELSE IF (ff > fmax)
THEN
161 WRITE (iout ,1200) sensor%SENS_ID,sensor%TSTART,fmax,ff
163#include "lockoff.inc"
165 ELSE IF (acti == 2)
THEN
168 WRITE (istdo,1300) sensor%SENS_ID,sensor%TSTART
169 WRITE (iout ,1300) sensor%SENS_ID,sensor%TSTART
170#include "lockoff.inc"
1741100
FORMAT(
' SENSOR (RWALL) NUMBER ',i10,
' ,ACTIVATED AT TIME ' ,1pe12.5)
1751200
FORMAT(
' SENSOR (RWALL) NUMBER ',i10,
' ,ACTIVATED AT TIME ',1pe12.5/
176 .
' TARGET FORCE VALUE =',1pe12.5/
177 .
' CURRENT VALUE AT TMIN + TDELAY =',1pe12.5)
1781300
FORMAT(
' SENSOR (RWALL) NUMBER ',i10,
' ,DEACTIVATED AT TIME ',1pe12.5)