39
40
41
42 USE sensor_mod
43
44
45
46#include "implicit_f.inc"
47#include "comlock.inc"
48
49
50
51#include "mvsiz_p.inc"
52
53
54
55#include "com06_c.inc"
56#include "param_c.inc"
57
58
59
60 INTEGER, INTENT(IN) :: NEL
61 INTEGER, INTENT(IN) :: IGRE
62 INTEGER IPARTR(*),IXR(NIXR,*),(*),IGRTH(*),
63 . NC1(*),NC2(*),NC3(*),ITASK
64
66 . geo(npropg,*),eint(*),partsav(npsav,*),v(3,*),
67 . al0(*),gresav(*),x(3,*),vr(3,*)
68 type (sensors_),INTENT(INOUT) :: SENSORS
69
70
71
72 INTEGER I,MX, , FLAG
74 . x1(mvsiz), x2(mvsiz), x3(mvsiz),
75 . y1(mvsiz), y2(mvsiz), y3(mvsiz),
76 . z1(mvsiz), z2(mvsiz), z3(mvsiz),
77 . v1(mvsiz,3),v2(mvsiz,3),v3(mvsiz,3),
78 . vr1(mvsiz,3),vr2(mvsiz,3),vr3(mvsiz,3),
79 . reintt, inel, in2,
80 . xmas(mvsiz),rek(mvsiz), xmas2(mvsiz),
81 . ek(mvsiz), xm(mvsiz), ym(mvsiz), zm(mvsiz),
82 . rbidon(1),off(mvsiz),
83 . xx(mvsiz) , yy(mvsiz) , zz(mvsiz) ,
84 . xy(mvsiz) , yz(mvsiz) , zx(mvsiz) ,
85 . xx2(mvsiz), yy2(mvsiz), zz2(mvsiz),
86 . xxm(mvsiz), yym(mvsiz), zzm(mvsiz),
87 . xcg(mvsiz), ycg(mvsiz), zcg(mvsiz),
88 . ixx(mvsiz), iyy(mvsiz), izz(mvsiz),
89 . ixy(mvsiz), iyz(mvsiz), izx(mvsiz),
90 . vxa(mvsiz), vya(mvsiz), vza(mvsiz),
91 . va2(mvsiz), vra2(mvsiz)
92
93 flag = 0
94 rbidon = zero
95 off = zero
96 reintt = zero
97 DO i=1,nel
98 reintt=reintt + eint(i)
99 ENDDO
100
101
102 reint = reint + reintt
103
104 DO i=1,nel
105 x1(i)=x(1,nc1(i))
106 y1(i)=x(2,nc1(i))
107 z1(i)=x(3,nc1(i))
108 x2(i)=x(1,nc2(i))
109 y2(i)=x(2,nc2(i))
110 z2(i)=x(3,nc2(i))
111 x3(i)=x(1,nc3(i))
112 y3(i)=x(2,nc3(i))
113 z3(i)=x(3,nc3(i))
114 v1(i,1)=v(1,nc1(i))
115 v1(i,2)=v(2,nc1(i))
116 v1(i,3)=v(3,nc1(i))
117 v2(i,1)=v(1,nc2(i))
118 v2(i,2)=v(2,nc2(i))
119 v2(i,3)=v(3,nc2(i))
120 v3(i,1)=v(1,nc3(i))
121 v3(i,2)=v(2,nc3(i))
122 v3(i,3)=v(3,nc3(i))
123 vr1(i,1)=vr(1,nc1(i))
124 vr1(i,2)=vr(2,nc1(i))
125 vr1(i,3)=vr(3,nc1(i))
126 vr2(i,1)=vr(1,nc2(i))
127 vr2(i,2)=vr(2,nc2(i))
128 vr2(i,3)=vr(3,nc2(i))
129 vr3(i,1)=vr(1,nc3(i))
130 vr3(i,2)=vr(2,nc3(i))
131 vr3(i,3)=vr(3,nc3(i))
132 ENDDO
133
134 DO i=1,nel
135 xx(i)= half*(x1(i)+x3(i))+x2(i)
136 yy(i)= half*(y1(i)+y3(i))+y2(i)
137 zz(i)= half*(z1(i)+z3(i))+z2(i)
138 xx2(i) = half*(x1(i)*x1(i)+x3(i)*x3(i))+x2(i)*x2(i)
139 yy2(i) = half*(y1(i)*y1(i)+y3(i)*y3(i))+y2(i)*y2(i)
140 zz2(i) = half*(z1(i)*z1(i)+z3(i)*z3(i))+z2(i)*z2(i)
141 xy(i) = half*(x1(i)*y1(i)+x3(i)*y3(i))+x2(i)*y2(i)
142 yz(i) = half*(y1(i)*z1(i)+y3(i)*z3(i))+y2(i)*z2(i)
143 zx(i) = half*(z1(i)*x1(i)+z3(i)*x3(i))+z2(i)*x2(i)
144 vxa(i)=half*(v1(i,1)+v3(i,1))+v2(i,1)
145 vya(i)=half*(v1(i,2)+v3(i,2))+v2(i,2)
146 vza(i)=half*(v1(i,3)+v3(i,3))+v2(i,3)
147 va2(i)=half*(v1(i,1)*v1(i,1)+v3(i,1)*v3(i,1)
148 . +v1(i,2)*v1(i,2)+v3(i,2)*v3(i,2)
149 . +v1(i,3)*v1(i,3)+v3(i,3)*v3(i,3))
150 . +v2(i,1)*v2(i,1)+v2(i,2)*v2(i,2)+v2(i,3)*v2(i,3)
151 vra2(i) = half*(vr1(i,1)*vr1(i,1)+vr3(i,1)*vr3(i,1)
152 . +vr1(i,2)*vr1(i,2)+vr3(i,2)*vr3(i,2)
153 . +vr1(i,3)*vr1(i,3)+vr3(i,3)*vr3(i,3))
154 . +vr2(i,1)*vr2(i,1)+vr2(i,2)*vr2(i,2)
155 . +vr2(i,3)*vr2(i,3)
156 ENDDO
157
158 DO i=1,nel
159 ileng=nint(geo(93,ixr(1,i)))
160 IF (ileng /= 0) THEN
161 xmas(i)=geo(1,ixr(1,i))*al0(i)
162 ELSE
163 xmas(i)=geo(1,ixr(1,i))
164 ENDIF
165 xmas2(i)=xmas(i)*half
166 xm(i)= xmas2(i)*vxa(i)
167 ym(i)= xmas2(i)*vya(i)
168 zm(i)= xmas2(i)*vza(i)
169 ek(i)= xmas2(i)*va2(i)*half
170 ENDDO
171
172 DO i=1,nel
173 xcg(i)= xmas2(i)*xx(i)
174 ycg(i)= xmas2(i)*yy(i)
175 zcg(i)= xmas2(i)*zz(i)
176 ileng=nint(geo(93,ixr(1,i)))
177 IF (ileng /= 0) THEN
178 inel=geo(9,ixr(1,i))*al0(i)
179 ELSE
180 inel=geo(9,ixr(1,i))
181 ENDIF
182 in2 = inel*half
183 ixy(i) = -xmas2(i)*xy(i)
184 iyz(i) = -xmas2(i)*yz(i)
185 izx(i) = -xmas2(i)*zx(i)
186 ixx(i)= inel + xmas2(i)*(yy2(i) + zz2(i))
187 iyy(i)= inel + xmas2(i)*(zz2(i) + xx2(i))
188 izz(i)= inel + xmas2(i)*(xx2(i) + yy2(i))
189
190 xxm(i)= xmas2(i)*
191 . (half*(v1(i,3)*y1(i)-v1(i,2)*z1(i)
192 . +v3(i,3)*y3(i)-v3(i,2)*z3(i))
193 . +v2(i,3)*y2(i)-v2(i,2)*z2(i))
194 . +in2*(half*(vr1(i,1)+vr3(i,1))+vr2(i,1))
195 yym(i)= xmas2(i)*
196 . (half*(v1(i,1)*z1(i)-v1(i,3)*x1(i)
197 . +v3(i,1)*z3(i)-v3(i,3)*x3(i))
198 . +v2(i,1)*z2(i)-v2(i,3)*x2(i))
199 . +in2*(half*(vr1(i,2)+vr3(i,2))+vr2(i,2))
200 zzm(i)= xmas2(i)*
201 . (half*(v1(i,2)*x1(i)-v1(i,1)*y1(i)
202 . +v3(i,2)*x3(i)-v3(i,1)*y3(i))
203 . +v2(i,2)*x2(i)-v2(i,1)*y2(i))
204 . +in2*(half*(vr1(i,3)+vr3(i,3))+vr2(i,3))
205 rek(i)= in2*va2(i)*half
206 ENDDO
207
208 IF (igre /= 0) THEN
209 DO i=1,nel
210 off(i) = one
211 ENDDO
213 2 off ,eint ,ek ,xm ,ym ,
214 3 zm ,xmas ,xcg ,ycg ,zcg ,
215 4 xxm ,yym ,zzm ,ixx ,iyy ,
216 5 izz ,ixy ,iyz ,izx ,rbidon,
217 6 rek ,flag )
218 ENDIF
219
220 DO i=1,nel
221 mx = ipartr(i)
222 partsav(1,mx)=partsav(1,mx) + eint(i)
223 partsav(2,mx)=partsav(2,mx) + ek(i)
224 partsav(3,mx)=partsav(3,mx) + xm(i)
225 partsav(4,mx)=partsav(4,mx) + ym(i)
226 partsav(5,mx)=partsav(5,mx) + zm(i)
227 partsav(6,mx)=partsav(6,mx) + xmas(i)
228 partsav(9,mx) =partsav(9,mx) + xcg(i)
229 partsav(10,mx)=partsav(10,mx) + ycg(i)
230 partsav(11,mx)=partsav(11,mx) + zcg(i)
231 partsav(12,mx)=partsav(12,mx) + xxm(i)
232 partsav(13,mx)=partsav(13,mx) + yym(i)
233 partsav(14,mx)=partsav(14,mx) + zzm(i)
234 partsav(15,mx)=partsav(15,mx) + ixx(i)
235 partsav(16,mx)=partsav(16,mx) + iyy(i)
236 partsav(17,mx)=partsav(17,mx) + izz(i)
237 partsav(18,mx)=partsav(18,mx) + ixy(i)
238 partsav(19,mx)=partsav(19,mx) + iyz(i)
239 partsav(20,mx)=partsav(20,mx) + izx(i)
240 partsav(22,mx)=partsav(22,mx) + rek(i)
241 ENDDO
242
243 off(1:mvsiz) = one
245
246 RETURN
subroutine grelem_sav(jft, jlt, gresav, igrth, grth, off, ei, ek, xm, ym, zm, xmas, xcg, ycg, zcg, xxm, yym, zzm, ixx, iyy, izz, ixy, iyz, izx, rei, rek, flag)
subroutine sensor_energy_bilan(jft, jlt, ei, ek, off, ipart, itask, sensors)