33
34
35
36 USE sensor_mod
37 use element_mod , only : nixr
38
39
40
41#include "implicit_f.inc"
42
43
44
45#include "param_c.inc"
46#include "com04_c.inc"
47
48
49
50 INTEGER ,INTENT(IN) :: NEL,NSENSOR
51 INTEGER ,DIMENSION(NIXR,NUMELR) ,INTENT(IN) :: IXR
53 TYPE (SENSOR_STR_) ,DIMENSION(NSENSOR) ,INTENT(INOUT) :: SENSOR_TAB
54
55
56
57 INTEGER :: I,J,SPRING_ID,ISENS,SPR_SKW,SEN_SKW,IDIR_F,IDIR_M
58 my_real :: fz,my,ftens,fcomp,mflex,mext,fgx,fgy,fgz,mgx,mgy,mgz
60 my_real ,
DIMENSION(LSKEW,NUMSKW) :: skew
61
62
63
64 isens = 0
65 DO j = 1,nsensor
66 IF (sensor_tab(j)%TYPE == 19) THEN
67 isens = j
68 sen_skw = sensor_tab(isens)%IPARAM(3)
69 spr_skw = sensor_tab(isens)%IPARAM(4)
70 idir_f = sensor_tab(isens)%IPARAM(5)
71 idir_m = sensor_tab(isens)%IPARAM(6)
72
73 ftens = sensor_tab(isens)%RPARAM(2)
74 fcomp = sensor_tab(isens)%RPARAM(3)
75 mflex = sensor_tab(isens)%RPARAM(4)
76 mext = sensor_tab(isens)%RPARAM(5)
77 EXIT
78 END IF
79 END DO
80
81 IF (isens > 0) THEN
82 my = zero
83 fz = zero
84 DO i = 1,nel
85 spring_id = ixr(6,i)
86 IF (sensor_tab(isens)%IPARAM(1) == spring_id) THEN
90 mm(1) = mom(i)
91 mm(2) = mom(i+nel)
92 mm(3) = mom(i+nel*2)
93
94 IF (sen_skw > 1) THEN
95 IF (sen_skw /= spr_skw) THEN
96 fgx = skew(1,spr_skw)*ff(1)+skew(4,spr_skw)*ff(2)+skew(7,spr_skw)*ff(3)
97 fgy = skew(2,spr_skw)*ff(1)+skew(5,spr_skw)*ff(2)+skew(8,spr_skw)*ff(3)
98 fgz = skew(3,spr_skw)*ff(1)+skew(6,spr_skw)*ff(2)+skew(9,spr_skw)*ff(3)
99 ff(1) = skew(1,sen_skw)*fgx+skew(2,sen_skw)*fgy+skew(3,sen_skw)*fgz
100 ff(2) = skew(4,sen_skw)*fgx+skew(5,sen_skw)*fgy+skew(6,sen_skw)*fgz
101 ff(3) = skew(7,sen_skw)*fgx+skew(8,sen_skw)*fgy+skew(9,sen_skw)*fgz
102 mgx = skew(1,spr_skw)*mm(1)+skew(4,spr_skw)*mm(2)+skew(7,spr_skw)*mm(3)
103 mgy = skew(2,spr_skw)*mm(1)+skew(5,spr_skw)*mm(2)+skew(8,spr_skw)*mm(3)
104 mgz = skew(3,spr_skw)*mm(1)+skew(6,spr_skw)*mm(2)+skew(9,spr_skw)*mm(3)
105 mm(1) = skew(1,sen_skw)*mgx+skew(2,sen_skw)*mgy+skew(3,sen_skw)*mgz
106 mm(2) = skew(4,sen_skw)*mgx+skew(5,sen_skw)*mgy+skew(6,sen_skw)*mgz
107 mm(3) = skew(7,sen_skw)*mgx+skew(8,sen_skw)*mgy+skew(9,sen_skw)*mgz
108 END IF
109 fz = ff(idir_f)
110 my = mm(idir_m)
111 END IF
112
113 IF (fz >= zero) THEN
114 fz = fz / ftens
115 ELSE
116 fz = abs(fz) / fcomp
117 END IF
118 IF (my >= zero) THEN
119 my = my / mflex
120 ELSE
121 my = abs(my) / mext
122 END IF
123 sensor_tab(isens)%VAR(1) = fz
124 sensor_tab(isens)%VAR(2) = my
125 sensor_tab(isens)%VAR(3) = one
126 EXIT
127 END IF
128 END DO
129 END IF
130
131 RETURN
for(i8=*sizetab-1;i8 >=0;i8--)