37
38
39
41
42
43
44#include "implicit_f.inc"
45
46
47
48#include "mvsiz_p.inc"
49
50
51
52#include "com04_c.inc"
53
54
55
56 INTEGER NSC, NSP, KSURF,KSI(*),
57 . IMPACT(*), NDAMP1, NDAMP2, NPC(*)
58
60 . x(3,*) ,v(3,*) , bufsf(*), ksc(*), ksp(*),
61 . cimp(3,*) ,nimp(3,*) , visc , gapmin, pld(*),
62 . ms(*) ,wf(*) , wst(*), stf
63 TYPE (SURF_) , DIMENSION(NSURF) :: IGRSURF
64
65
66
67 INTEGER ADRBUF, I, IL, IN
68 INTEGER NDEB, NREST
69 INTEGER DGR
70 INTEGER IPT,NPT,II,JJ
72 . a, b, c, an, bn, cn, rot(9),
73 . x1, x2, x3, n1, n2, n3, n,
74 . xpvn1, ypvn1, zpvn1, sgnxn, sgnyn, sgnzn,
75 . xm, ym, zm, xi, yi, zi,
76 . v1, v2, v3, vxm, vym, vzm, vrx, vry, vrz,
77 . vxp, vyp, vzp,vxi, vyi, vzi,
78 . dt1inv, ff
80 . xpv(3,mvsiz),nv(3,mvsiz),fnpv(mvsiz),vis(mvsiz),
81 . visc1(mvsiz),visc2(mvsiz),vn(mvsiz)
82
83 adrbuf=igrsurf(ksurf)%IAD_BUFR
84
85 a =bufsf(adrbuf+1)
86 b =bufsf(adrbuf+2)
87 c =bufsf(adrbuf+3)
88 dgr=bufsf(adrbuf+36)
89 an=a**dgr
90 bn=b**dgr
91 cn=c**dgr
92 an=one/an
93 bn=one/bn
94 cn=one/cn
95 DO i=1,9
96 rot(i)=bufsf(adrbuf+7+i-1)
97 END DO
98
99
100
101
102
103
104
105 x1=bufsf(adrbuf+16)-bufsf(adrbuf+4)
106 x2=bufsf(adrbuf+17)-bufsf(adrbuf+5)
107 x3=bufsf(adrbuf+18)-bufsf(adrbuf+6)
108 xm=rot(1)*x1+rot(2)*x2+rot(3)*x3
109 ym=rot(4)*x1+rot(5)*x2+rot(6)*x3
110 zm=rot(7)*x1+rot(8)*x2+rot(9)*x3
111
112
113
114 v1=bufsf(adrbuf+19)
115 v2=bufsf(adrbuf+20)
116 v3=bufsf(adrbuf+21)
117 vxm=rot(1)*v1+rot(2)*v2+rot(3)*v3
118 vym=rot(4)*v1+rot(5)*v2+rot(6)*v3
119 vzm=rot(7)*v1+rot(8)*v2+rot(9)*v3
120
121
122
123 v1=bufsf(adrbuf+22)
124 v2=bufsf(adrbuf+23)
125 v3=bufsf(adrbuf+24)
126 vrx=rot(1)*v1+rot(2)*v2+rot(3)*v3
127 vry=rot(4)*v1+rot(5)*v2+rot(6)*v3
128 vrz=rot(7)*v1+rot(8)*v2+rot(9)*v3
129
130
131
132 ndeb =0
133 nrest=nsc
134 100 CONTINUE
135
136 DO i=1,
min(mvsiz,nrest)
137 il=ksc(i+ndeb)
138 in=ksi(il)
139 fnpv(i) =wf(in)
140 nv(1,i) =nimp(1,il)
141 nv(2,i) =nimp(2,il)
142 nv(3,i) =nimp(3,il)
143 ENDDO
144
145
146
147
148 IF (ndamp1==0 .AND. ndamp2==0) THEN
149
150 DO i=1,
min(mvsiz,nrest)
151 il=ksc(i+ndeb)
152 in=ksi(il)
153 vis(i) = visc*2.*sqrt(stf*ms(in))
154 ENDDO
155 ELSEIF (ndamp1==0) THEN
156
157 CALL ninterp(ndamp2,npc,pld,
min(mvsiz,nrest),fnpv,visc2)
158 DO i=1,
min(mvsiz,nrest)
159 vis(i)=visc*visc2(i)
160 ENDDO
161 ELSEIF (ndamp2==0) THEN
162
163 DO i=1,
min(mvsiz,nrest)
164 il=ksc(i+ndeb)
165 in=ksi(il)
166 v1 =v(1,in)
167 v2 =v(2,in)
168 v3 =v(3,in)
169 vn(i) =v(1,in)*nv(1,i)+v(2,in)*nv(2,i)+v(3,in)*nv(3,i)
170 ENDDO
171 CALL ninterp(ndamp1,npc,pld,
min(mvsiz,nrest),vn,visc1)
172 DO i=1,
min(mvsiz,nrest)
173 vis(i)=visc*visc1(i)
174 ENDDO
175 ELSE
176
177 DO i=1,
min(mvsiz,nrest)
178 il=ksc(i+ndeb)
179 in=ksi(il)
180 v1 =v(1,in)
181 v2 =v(2,in)
182 v3 =v(3,in)
183 vn(i) =v(1,in)*nv(1,i)+v(2,in)*nv(2,i)+v(3,in)*nv(3,i)
184 ENDDO
185 CALL ninterp(ndamp1,npc,pld,
min(mvsiz,nrest),vn ,visc1)
186 CALL ninterp(ndamp2,npc,pld,
min(mvsiz,nrest),fnpv,visc2)
187 DO i=1,
min(mvsiz,nrest)
188 vis(i)=visc*visc1(i)*visc2(i)
189 ENDDO
190 ENDIF
191
192
193
194#include "vectorize.inc"
195 DO i=1,
min(mvsiz,nrest)
196 il=ksc(i+ndeb)
197 in=ksi(il)
198
199 IF (impact(il)>0) THEN
200 xi=cimp(1,il)+gapmin*nimp(1,il)
201 yi=cimp(2,il)+gapmin*nimp(2,il)
202 zi=cimp(3,il)+gapmin*nimp(3,il)
203
204 v1 =v(1,in)
205 v2 =v(2,in)
206 v3 =v(3,in)
207 vxp=rot(1)*v1+rot(2)*v2+rot(3)*v3
208 vyp=rot(4)*v1+rot(5)*v2+rot(6)*v3
209 vzp=rot(7)*v1+rot(8)*v2+rot(9)*v3
210
211 vxi=vxm+(ym-yi)*vrz-(zm-zi)*vry
212 vyi=vym-(xm-xi)*vrz+(zm-zi)*vrx
213 vzi=vzm+(xm-xi)*vry-(ym-yi)*vrx
214
215 ff =-vis(i)*(nv(1,i)*(vxp-vxi)+nv(2,i)*(vyp-vyi)
216 . +nv(3,i)*(vzp-vzi))
217
218 wf(in) = fnpv(i)+ff
219 wst(in) = vis(i)
220 ELSE
221 wst(in)=zero
222 END IF
223 ENDDO
224
225 IF (nrest-mvsiz>0) THEN
226 nrest=nrest-mvsiz
227 ndeb =ndeb +mvsiz
228 GOTO 100
229 ENDIF
230
231
232
233 ndeb =0
234 nrest=nsp
235 200 CONTINUE
236
237 DO i=1,
min(mvsiz,nrest)
238 il=ksp(i+ndeb)
239 in=ksi(il)
240 fnpv(i) =wf(in)
241 nv(1,i) =nimp(1,il)
242 nv(2,i) =nimp(2,il)
243 nv(3,i) =nimp(3,il)
244 ENDDO
245
246
247
248
249 IF (ndamp1==0 .AND. ndamp2==0) THEN
250
251 DO i=1,
min(mvsiz,nrest)
252 il=ksp(i+ndeb)
253 in=ksi(il)
254 vis(i) = visc*two*sqrt(stf*ms(in))
255 ENDDO
256 ELSEIF (ndamp1==0) THEN
257
258 CALL ninterp(ndamp2,npc,pld,
min(mvsiz,nrest),fnpv,visc2)
259 DO i=1,
min(mvsiz,nrest)
260 vis(i)=visc*visc2(i)
261 ENDDO
262 ELSEIF (ndamp2==0) THEN
263
264 DO i=1,
min(mvsiz,nrest)
265 il=ksp(i+ndeb)
266 in=ksi(il)
267 v1 =v(1,in)
268 v2 =v(2,in)
269 v3 =v(3,in)
270 vn(i) =v(1,in)*nv(1,i)+v(2,in)*nv(2,i)+v(3,in)*nv(3,i)
271 ENDDO
272 CALL ninterp(ndamp1,npc,pld,
min(mvsiz,nrest),vn,visc1)
273 DO i=1,
min(mvsiz,nrest)
274 vis(i)=visc*visc1(i)
275 ENDDO
276 ELSE
277
278 DO i=1,
min(mvsiz,nrest)
279 il=ksp(i+ndeb)
280 in=ksi(il)
281 v1 =v(1,in)
282 v2 =v(2,in)
283 v3 =v(3,in)
284 vn(i) =v(1,in)*nv(1,i)+v(2,in)*nv(2,i)+v(3,in)*nv(3,i)
285 ENDDO
286 CALL ninterp(ndamp1,npc,pld,
min(mvsiz,nrest),vn ,visc1)
287 CALL ninterp(ndamp2,npc,pld,
min(mvsiz,nrest),fnpv,visc2)
288 DO i=1,
min(mvsiz,nrest)
289 vis(i)=visc*visc1(i)*visc2(i)
290 ENDDO
291 ENDIF
292
293
294
295#include "vectorize.inc"
296 DO i=1,
min(mvsiz,nrest)
297 il=ksp(i+ndeb)
298 in=ksi(il)
299
300 xi=cimp(1,il)+gapmin*nimp(1,il)
301 yi=cimp(2,il)+gapmin*nimp(2,il)
302 zi=cimp(3,il)+gapmin*nimp(3,il)
303
304 v1 =v(1,in)
305 v2 =v(2,in)
306 v3 =v(3,in)
307 vxp=rot(1)*v1+rot(2)*v2+rot(3)*v3
308 vyp=rot(4)*v1+rot(5)*v2+rot(6)*v3
309 vzp=rot(7)*v1+rot(8)*v2+rot(9)*v3
310
311 vxi=vxm+(ym-yi)*vrz-(zm-zi)*vry
312 vyi=vym-(xm-xi)*vrz+(zm-zi)*vrx
313 vzi=vzm+(xm-xi)*vry-(ym-yi)*vrx
314
315 ff =-vis(i)*(nv(1,i)*(vxp-vxi)+nv(2,i)*(vyp-vyi)
316 . +nv(3,i)*(vzp-vzi))
317
318 wf(in) = fnpv(i)+ff
319 wst(in) = vis(i)
320 ENDDO
321
322 IF (nrest-mvsiz>0) THEN
323 nrest=nrest-mvsiz
324 ndeb =ndeb +mvsiz
325 GOTO 200
326 ENDIF
327
328 RETURN
subroutine ninterp(ifunc, npc, pld, npoint, xv, yv)