39#include "implicit_f.inc"
51 INTEGER :: DIMFB,STABS
52 INTEGER :: TABS(STABS)
53 DOUBLE PRECISION FBSAV6(12,6,DIMFB)
54 TYPE (SENSOR_STR_) ,
TARGET :: SENSOR
58 INTEGER I,RBOD_ID,IDIR,ICRIT,ISECT,IFLAG,IAD
60 my_real :: fmin,fmax,fx,fy,fz,ff,tstart,tmin,tdelay,infinity
61 parameter(infinity = 1.0e20)
63 IF (sensor%STATUS == 1)
RETURN
65 tstart = sensor%TSTART
67 tdelay = sensor%TDELAY
69 rbod_id = sensor%IPARAM(1)
70 idir = sensor%IPARAM(2)
71 fmin = sensor%RPARAM(1)
72 fmax = sensor%RPARAM(2)
76 iad = ninter + nrwall + rbod_id
77 isect = tabs(rbod_id + nsect + ninter + nintsub+nrwall+1)
78 . - tabs(rbod_id + nsect + ninter + nintsub+nrwall)
80 fx = fbsav6(1,1,isect) + fbsav6(1,2,isect)
81 . + fbsav6(1,3,isect) + fbsav6(1,4,isect)
82 . + fbsav6(1,5,isect) + fbsav6(1,6,isect)
83 fy = fbsav6(2,1,isect) + fbsav6(2,2,isect)
84 . + fbsav6(2,3,isect) + fbsav6(2,4,isect)
85 . + fbsav6(2,5,isect) + fbsav6(2,6,isect)
86 fz = fbsav6(3,1,isect) + fbsav6(3,2,isect)
87 . + fbsav6(3,3,isect) + fbsav6(3,4,isect)
88 . + fbsav6(3,5,isect) + fbsav6(3,6,isect)
89 ff = sqrt(fx*fx + fy*fy + fz*fz)
91 fx = fbsav6(4,1,isect) + fbsav6(4,2,isect)
92 . + fbsav6(4,3,isect) + fbsav6(4,4,isect)
93 . + fbsav6(4,5,isect) + fbsav6(4,6,isect)
94 fy = fbsav6(5,1,isect) + fbsav6(5,2,isect)
95 . + fbsav6(5,3,isect) + fbsav6(5,4,isect)
96 . + fbsav6(5,5,isect) + fbsav6(5,6,isect)
97 fz = fbsav6(6,1,isect) + fbsav6(6,2,isect)
98 . + fbsav6(6,3,isect) + fbsav6(6,4,isect)
99 . + fbsav6(6,5,isect) + fbsav6(6,6,isect)
100 ff = sqrt(fx*fx + fy*fy + fz*fz)
106 ELSE IF (ff > fmax)
THEN
110 sensor%RESULTS(1) = ff
114 IF (sensor%TCRIT + tmin > tt)
THEN
116 sensor%TCRIT = infinity
117 ELSE IF (sensor%TCRIT == infinity)
THEN
121 IF (sensor%TCRIT < infinity) tstart = sensor%TCRIT + tmin + tdelay
122 IF (tstart <= tt)
THEN
124 sensor%TSTART = tstart
127 IF (sensor%STATUS == 1 .and. ispmd == 0)
THEN
129 WRITE (istdo,1100) sensor%SENS_ID,sensor%TSTART
130 WRITE (iout ,1100) sensor%SENS_ID,sensor%TSTART
132 WRITE (iout ,1200) fmin,ff
133 ELSE IF (iflag == 2)
THEN
134 WRITE (iout ,1300) fmax,ff
136#include "lockoff.inc"
1391100
FORMAT(
' SENSOR (RBODY) NUMBER ',i10,
' ,ACTIVATED AT TIME ',1pe12.5)
1401200
FORMAT(
' TARGET MIN FORCE = ',1pe12.5,/
141 .
' CURRENT FORCE AFTER TMIN and TDELAY = ',1pe12.5)
1421300
FORMAT(
' TARGET MAX FORCE = ',1pe12.5,/
143 .
' CURRENT FORCE AFTER TMIN and TDELAY = ',1pe12.5)
subroutine sensor_rbody(sensor, dimfb, stabs, tabs, fbsav6)