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