Debian Codegraph @

packages/seacas/applications/gjoin/gj_matxyz.f

raw
1 C Copyright(C) 1999-2020 National Technology & Engineering Solutions
2 C of Sandia, LLC (NTESS). Under the terms of Contract DE-NA0003525 with
3 C NTESS, the U.S. Government retains certain rights in this software.
4 C
5 C See packages/seacas/LICENSE for details
6
7 C -*- Mode: fortran -*-
8 C=======================================================================
9
10 SUBROUTINE MATXYZ (NDIM,
11 & MATNS1, MATNS2, NNNPS, IXNNPS, LTNNPS,
12 & NUMNP1, XN1, YN1, ZN1, NUMNP2, XN2, YN2, ZN2,
13 & IX1, IX2, IXNP2, NMATCH, TOLER, CLOSE, IEXPCT)
14 C=======================================================================
15
16 C --*** MATXYZ *** (GJOIN) Find matching nodes
17 C -- Written by Amy Gilkey - revised 03/04/88
18 C --
19 C --MATXYZ matches nodes from the first and second database by comparing
20 C --the coordinates. Since some slack is needed in the equality check,
21 C --the comparison may not work for all meshes. The nodes to be matched
22 C --may be limited to nodes in two nodal point sets.
23 C --
24 C --Parameters:
25 C -- NDIM - IN - the number of coordinates per node
26 C -- MATNS1 - IN - the number of the first nodal point set
27 C -- MATNS2 - IN - the number of the second nodal point set
28 C -- NNNPS - IN - the number of nodes for each set
29 C -- IXNNPS - IN - the indices of the nodes for each set
30 C -- LTNNPS - IN - the nodes for each set
31 C -- LNPS2 - IN - the length of the nodal point set for the second database
32 C -- NPS2 - IN - the nodes in the nodal point set for the second database
33 C -- NUMNP1 - IN - the number of nodes in the first database
34 C -- XN1, YN1, ZN1 - IN - the coordinates in the first database
35 C -- NUMNP2 - IN - the number of nodes in the second database
36 C -- XN2, YN2, ZN2 - IN - the coordinates in the second database
37 C -- IX1 - SCRATCH - size = NUMNP1
38 C -- IX2 - SCRATCH - size = NUMNP2
39 C -- IXNP2 - IN/OUT - the index of the matching first database node;
40 C -- negative if no match; reset if NMATCH = 0
41 C -- NMATCH - IN/OUT - the number of matching nodes
42 C -- CLOSE - IN/OUT - true if match closest node, false if match any
43 C -- node within tolerance.
44 C -- IEXPCT - IN - number of expected nodal point matches. Abort
45 C -- if actual matches not equal.
46
47 include 'gj_filnum.blk'
48 INTEGER NNNPS(*), IXNNPS(*), LTNNPS(*)
49 REAL XN1(*), YN1(*), ZN1(*)
50 REAL XN2(*), YN2(*), ZN2(*)
51 INTEGER IX1(*), IX2(*)
52 INTEGER IXNP2(*)
53 LOGICAL CLOSE
54
55 PARAMETER (MXNAM = 1)
56 DIMENSION KV(MXNAM), RV(MXNAM), IVAL(MXNAM)
57 CHARACTER*8 CV(MXNAM)
58
59 CHARACTER*80 STRING
60 LOGICAL INIT
61 LOGICAL BYSET
62 LOGICAL OK
63
64 BYSET = (MATNS1 .GT. 0) .AND. (MATNS2 .GT. 0)
65 INIT = (NMATCH .LE. 0)
66 NSVMAT = NMATCH
67
68 C --Index nodes to match in the nodal point sets
69
70 IF (BYSET) THEN
71 IN1 = 0
72 IX0 = IXNNPS(MATNS1) - 1
73 DO 100 N = 1, NNNPS(MATNS1)
74 IN1 = IN1 + 1
75 IX1(IN1) = LTNNPS(IX0+N)
76 100 CONTINUE
77
78 IN2 = 0
79 IX0 = IXNNPS(MATNS2) - 1
80 DO 110 N = 1, NNNPS(MATNS2)
81 IN2 = IN2 + 1
82 IX2(IN2) = LTNNPS(IX0+N)
83 110 CONTINUE
84 END IF
85
86 time0 = 0.0
87 time1 = 0.0
88 time2 = 0.0
89 C --Find the limits of the overlapping area of the two databases
90
91 IF (BYSET) THEN
92 CALL MINMXS (IN1, IX1, XN1, X1MIN, X1MAX)
93 CALL MINMXS (IN2, IX2, XN2, X2MIN, X2MAX)
94 CALL MINMXS (IN1, IX1, YN1, Y1MIN, Y1MAX)
95 CALL MINMXS (IN2, IX2, YN2, Y2MIN, Y2MAX)
96 IF (NDIM .GE. 3) THEN
97 CALL MINMXS (IN1, IX1, ZN1, Z1MIN, Z1MAX)
98 CALL MINMXS (IN2, IX2, ZN2, Z2MIN, Z2MAX)
99 END IF
100 ELSE
101 CALL MINMAX (NUMNP1, XN1, X1MIN, X1MAX)
102 CALL MINMAX (NUMNP2, XN2, X2MIN, X2MAX)
103 CALL MINMAX (NUMNP1, YN1, Y1MIN, Y1MAX)
104 CALL MINMAX (NUMNP2, YN2, Y2MIN, Y2MAX)
105 IF (NDIM .GE. 3) THEN
106 CALL MINMAX (NUMNP1, ZN1, Z1MIN, Z1MAX)
107 CALL MINMAX (NUMNP2, ZN2, Z2MIN, Z2MAX)
108 END IF
109 END IF
110 XMIN = MAX (X1MIN, X2MIN)
111 XMAX = MIN (X1MAX, X2MAX)
112 YMIN = MAX (Y1MIN, Y2MIN)
113 YMAX = MIN (Y1MAX, Y2MAX)
114 IF (NDIM .GE. 3) THEN
115 ZMIN = MAX (Z1MIN, Z2MIN)
116 ZMAX = MIN (Z1MAX, Z2MAX)
117 ELSE
118 ZMIN = 0.0
119 ZMAX = 0.0
120 END IF
121
122 DELTAX = XMAX - XMIN
123 DELTAY = YMAX - YMIN
124 DELTAZ = ZMAX - ZMIN
125
126 EPS = (DELTAX + DELTAY + DELTAZ) / 1E3
127 IF (EPS .LT. 0.0) THEN
128 CALL PRTERR ('ERROR', 'Nodes do not overlap')
129 GOTO 180
130 END IF
131
132 IF (TOLER .GE. 0.0) THEN
133 EPS = TOLER
134 ELSE
135 WRITE (*, 10040) EPS
136 10040 FORMAT (/' Default tolerance = ',1PE10.3)
137 CALL FREFLD (0, 0,
138 * 'Enter new value for tolerance (<ret> for default): ',
139 * MXNAM, IOS, NF, KV, CV, IVAL, RV)
140 IF (IOS .NE. 0) RV(1) = 0.0
141 IF (RV(1) .NE. 0.0) EPS = RV(1)
142 CALL OUTLOG (KLOG, 1, 1, CV, IVAL, EPS)
143 ENDIF
144 OK = .TRUE.
145 OK = OK .AND.
146 & ((MIN (X1MAX, X2MAX) - MAX (X1MIN, X2MIN)) .GT. -EPS)
147 OK = OK .AND.
148 & ((MIN (Y1MAX, Y2MAX) - MAX (Y1MIN, Y2MIN)) .GT. -EPS)
149 IF (NDIM .EQ. 3) THEN
150 OK = OK .AND.
151 & ((MIN (Z1MAX, Z2MAX) - MAX (Z1MIN, Z2MIN)) .GT. -EPS)
152 END IF
153 IF (.NOT. OK) THEN
154 CALL PRTERR ('ERROR', 'Nodes do not overlap')
155 GOTO 180
156 END IF
157
158 XMIN = XMIN - EPS
159 XMAX = XMAX + EPS
160 YMIN = YMIN - EPS
161 YMAX = YMAX + EPS
162 ZMIN = ZMIN - EPS
163 ZMAX = ZMAX + EPS
164
165 C --Index the nodes within the overlap area
166
167 Z3D = 0.0
168 IF (.NOT. BYSET) THEN
169 IN1 = 0
170 Z3D = 0.0
171 DO 120 INP = 1, NUMNP1
172 IF ((XN1(INP) .GE. XMIN) .AND. (XN1(INP) .LE. XMAX)) THEN
173 IF ((YN1(INP) .GE. YMIN) .AND. (YN1(INP) .LE. YMAX)) THEN
174 IF (NDIM .GE. 3) Z3D = ZN1(INP)
175 IF ((Z3D .GE. ZMIN) .AND. (Z3D .LE. ZMAX)) THEN
176 IN1 = IN1 + 1
177 IX1(IN1) = INP
178
179 END IF
180 END IF
181 END IF
182 120 CONTINUE
183
184 IN2 = 0
185 IF (NDIM .LT. 3) Z3D = 0.0
186 DO 130 INP = 1, NUMNP2
187 IF ((XN2(INP) .GE. XMIN) .AND. (XN2(INP) .LE. XMAX)) THEN
188 IF ((YN2(INP) .GE. YMIN) .AND. (YN2(INP) .LE. YMAX)) THEN
189 IF (NDIM .GE. 3) Z3D = ZN2(INP)
190 IF ((Z3D .GE. ZMIN) .AND. (Z3D .LE. ZMAX)) THEN
191 IN2 = IN2 + 1
192 IX2(IN2) = INP
193 END IF
194 END IF
195 END IF
196 130 CONTINUE
197 ELSE
198
199 C ... Equivalencing being done by nodesets.
200 C ... Index nodes in nodeset that are within overlap area.
201 IN1 = 0
202 IX0 = IXNNPS(MATNS1) - 1
203 DO 135 N = 1, NNNPS(MATNS1)
204 INP = LTNNPS(IX0+N)
205 IF ((XN1(INP) .GE. XMIN) .AND. (XN1(INP) .LE. XMAX)) THEN
206 IF ((YN1(INP) .GE. YMIN) .AND. (YN1(INP) .LE. YMAX)) THEN
207 IF (NDIM .GE. 3) Z3D = ZN1(INP)
208 IF ((Z3D .GE. ZMIN) .AND. (Z3D .LE. ZMAX)) THEN
209 IN1 = IN1 + 1
210 IX1(IN1) = INP
211 END IF
212 END IF
213 END IF
214 135 CONTINUE
215
216 IN2 = 0
217 IX0 = IXNNPS(MATNS2) - 1
218 DO 136 N = 1, NNNPS(MATNS2)
219 INP = LTNNPS(IX0+N)
220 IF ((XN2(INP) .GE. XMIN) .AND. (XN2(INP) .LE. XMAX)) THEN
221 IF ((YN2(INP) .GE. YMIN) .AND. (YN2(INP) .LE. YMAX)) THEN
222 IF (NDIM .GE. 3) Z3D = ZN2(INP)
223 IF ((Z3D .GE. ZMIN) .AND. (Z3D .LE. ZMAX)) THEN
224 IN2 = IN2 + 1
225 IX2(IN2) = INP
226 END IF
227 END IF
228 END IF
229 136 CONTINUE
230 END IF
231
232 C --Blank out the IXNP2 array
233
234 IF (INIT) THEN
235 DO 140 INP = 1, NUMNP2
236 IXNP2(INP) = -999
237 140 CONTINUE
238 ELSE
239 DO 150 INP = 1, NUMNP2
240 IF (IXNP2(INP) .GT. 0) THEN
241 I = LOCINT (INP, IN2, IX2)
242 IF (I .GT. 0) THEN
243 IX2(I) = IX2(IN2)
244 IN2 = IN2 - 1
245 END IF
246 I = LOCINT (IXNP2(INP), IN1, IX1)
247 IF (I .GT. 0) THEN
248 IX1(I) = IX1(IN1)
249 IN1 = IN1 - 1
250 END IF
251 END IF
252 150 CONTINUE
253 END IF
254
255 C -- Find all matching nodes by comparing coordinates of nodes in overlap
256 C area
257 DELMAX = MAX(DELTAX, DELTAY, DELTAZ)
258
259 call excpus(time0)
260 imat = 0
261 if (DELMAX .EQ. DELTAX) THEN
262 imat = 1
263 call indexn(xn1, 1, 1, ix1, in1, .FALSE.)
264 call indexn(xn2, 1, 1, ix2, in2, .FALSE.)
265 call prterr('CMDSPEC', 'Entering Sorting Phase, Sort on X')
266 else if (delmax .eq. deltay) then
267 imat = 2
268 call indexn(yn1, 1, 1, ix1, in1, .FALSE.)
269 call indexn(yn2, 1, 1, ix2, in2, .FALSE.)
270 call prterr('CMDSPEC', 'Entering Sorting Phase, Sort on Y')
271 else if (ndim .ge. 3 .and. delmax .eq. deltaz) then
272 imat = 3
273 call indexn(zn1, 1, 1, ix1, in1, .FALSE.)
274 call indexn(zn2, 1, 1, ix2, in2, .FALSE.)
275 call prterr('CMDSPEC', 'Entering Sorting Phase, Sort on Z')
276 end if
277 call prterr('CMDSPEC', 'Entering Comparison Phase')
278
279 CALL EXCPUS(time1)
280 DISMIN = 1.0E38
281 DISMAX = -1.0E38
282 NCOMP = 0
283 nout = 0
284 WRITE (*,'(A)') ' '
285 WRITE (*,'(A)') ' '
286
287 Z3D = 0.0
288 Z = 0.0
289 IN1SV = IN1
290 IN2SV = IN2
291
292 I2BEG = 1
293 I1BEG = 1
294
295 if (in1sv .lt. in2sv) then
296
297 DO 170 I1 = 1, IN1SV
298 INP1 = IX1(I1)
299 X = XN1(INP1)
300 Y = YN1(INP1)
301 IF (NDIM .GE. 3) Z = ZN1(INP1)
302 DMIN = 1.0E38
303 NDMIN = 0
304 I2BEGS = I2BEG
305 DO 160 I2 = I2BEGS, IN2SV
306 NCOMP = NCOMP + 1
307 nout = nout + 1
308 IF ( nout .ge. 100000) THEN
309 NCMPX = (IN1SV - I1) * IN2 + (IN2 - I2)
310 WRITE (*, 10020) NCOMP, NCMPX
311 nout = 0
312 END IF
313 INP2 = IX2(I2)
314 if (inp2 .le. 0) goto 160
315 IF (NDIM .GE. 3) Z3D = ZN2(INP2)
316
317 if ((imat .eq. 1 .and. (x-eps .gt. xn2(inp2))) .or.
318 * (imat .eq. 2 .and. (y-eps .gt. yn2(inp2))) .or.
319 * (imat .eq. 3 .and. (z-eps .gt. z3d))) then
320 i2beg = i2
321 goto 160
322 end if
323
324 C ... Since we are sorted on coordinat X|Y|Z,
325 C if set 2 X|Y|Z greater than set 1 X|Y|Z+eps, go to next X1|Y1|Z1 coord.
326 if ((imat .eq. 1 .and. xn2(inp2)-eps .gt. x) .or.
327 * (imat .eq. 2 .and. yn2(inp2)-eps .gt. y) .or.
328 * (imat .eq. 3 .and. z3d -eps .gt. z)) goto 165
329
330 DIS = MAX (ABS (XN2(INP2) - X), ABS(YN2(INP2) - Y),
331 * ABS (Z3D - Z) )
332 IF ( (DIS .LE. EPS .AND. .NOT. CLOSE) .OR.
333 $ DIS .EQ. 0.0) THEN
334 DISMAX = MAX(DISMAX, DIS)
335 NMATCH = NMATCH + 1
336 IXNP2(INP2) = INP1
337 IX2(I2) = -IX2(I2)
338 IN2 = IN2 - 1
339 IX1(I1) = 0
340 IN1 = IN1 - 1
341 GOTO 170
342 ELSE IF (DIS .LE. EPS .AND. CLOSE) THEN
343 IF (DIS .LT. DMIN) THEN
344 DMIN = DIS
345 NDMIN = I2
346 END IF
347 ELSE
348 DISMIN = MIN(DISMIN, DIS)
349 END IF
350 160 CONTINUE
351 165 CONTINUE
352 IF (CLOSE) THEN
353 IF (DMIN .LE. EPS) THEN
354 DISMAX = MAX(DISMAX, DMIN)
355 NMATCH = NMATCH + 1
356 INP2 = IX2(NDMIN)
357 IXNP2(INP2) = INP1
358 IX2(NDMIN) = -IX2(NDMIN)
359 IN2 = IN2 - 1
360 IX1(I1) = 0
361 IN1 = IN1 - 1
362 END IF
363 END IF
364 170 CONTINUE
365
366 else
367
368 DO 270 I2 = 1, IN2SV
369 INP2 = IX2(I2)
370 if (inp2 .le. 0) goto 270
371 X = XN2(INP2)
372 Y = YN2(INP2)
373 IF (NDIM .GE. 3) Z = ZN2(INP2)
374 DMIN = 1.0E38
375 NDMIN = 0
376 I1BEGS = I1BEG
377 DO 260 I1 = I1BEGS, IN1SV
378 NCOMP = NCOMP + 1
379 nout = nout + 1
380 IF ( nout .ge. 100000) THEN
381 NCMPX = (IN2SV - I2) * IN1 + (IN1 - I1)
382 WRITE (*, 10020) NCOMP, NCMPX
383 nout = 0
384 END IF
385 INP1 = IX1(I1)
386 if (inp1 .le. 0) goto 260
387 IF (NDIM .GE. 3) Z3D = ZN1(INP1)
388
389 if ((imat .eq. 1 .and. (x-eps .gt. xn1(inp1))) .or.
390 * (imat .eq. 2 .and. (y-eps .gt. yn1(inp1))) .or.
391 * (imat .eq. 3 .and. (z-eps .gt. z3d))) then
392 i1beg = i1
393 goto 260
394 end if
395
396 C ... Since we are sorted on coordinat X|Y|Z,
397 C if set 1 X|Y|Z greater than set 2 X|Y|Z+eps, go to next X2|Y2|Z2 coord.
398 if ((imat .eq. 1 .and. xn1(inp1)-eps .gt. x) .or.
399 * (imat .eq. 2 .and. yn1(inp1)-eps .gt. y) .or.
400 * (imat .eq. 3 .and. z3d -eps .gt. z)) goto 265
401
402 DIS = MAX (ABS (XN1(INP1) - X), ABS(YN1(INP1) - Y),
403 * ABS (Z3D - Z) )
404 IF ( (DIS .LE. EPS .AND. .NOT. CLOSE) .OR.
405 $ DIS .EQ. 0.0) THEN
406 DISMAX = MAX(DISMAX, DIS)
407 NMATCH = NMATCH + 1
408 IXNP2(INP2) = INP1
409 IX2(I2) = -IX2(I2)
410 IN2 = IN2 - 1
411 IX1(I1) = 0
412 IN1 = IN1 - 1
413 GOTO 270
414 ELSE IF (DIS .LE. EPS .AND. CLOSE) THEN
415 IF (DIS .LT. DMIN) THEN
416 DMIN = DIS
417 NDMIN = I1
418 END IF
419 ELSE
420 DISMIN = MIN(DISMIN, DIS)
421 END IF
422 260 CONTINUE
423 265 CONTINUE
424 IF (CLOSE) THEN
425 IF (DMIN .LE. EPS) THEN
426 DISMAX = MAX(DISMAX, DMIN)
427 NMATCH = NMATCH + 1
428 INP1 = IX1(NDMIN)
429 IXNP2(INP2) = INP1
430 IX2(I2) = -IX2(I2)
431 IN2 = IN2 - 1
432 IX1(NDMIN) = 0
433 IN1 = IN1 - 1
434 END IF
435 END IF
436 270 CONTINUE
437
438 end if
439
440 CALL EXCPUS(time2)
441 IF (BYSET) THEN
442 IF ((IN1 .GT. 0) .AND. (IN2 .GT. 0)) THEN
443 CALL PRTERR ('WARNING',
444 & 'All nodes in nodal point set cannot be matched')
445 END IF
446 END IF
447
448 WRITE (*, 10050) NCOMP
449 WRITE (*, 10021) EPS
450 IF (DISMAX .GT. -1.0E37) THEN
451 WRITE (*, 10025) DISMAX
452 END IF
453 IF (DISMIN .LT. 1.0E37) THEN
454 WRITE (*, 10030) DISMIN
455 END IF
456 IF (CLOSE) THEN
457 WRITE (*, 10035)
458 END IF
459 180 CONTINUE
460 IF (INIT) THEN
461 WRITE (STRING, 10000) NMATCH
462 CALL SQZSTR (STRING, LSTR)
463 WRITE (*, 10010) STRING(:LSTR)
464 IF (IEXPCT .NE. 0 .AND. IEXPCT .NE. NMATCH) then
465 call prterr ('ERROR',
466 $ 'Expected number of matches not equal to actual')
467 STOP 'Node Match Error'
468 END IF
469 ELSE
470 WRITE (STRING, 10000) NMATCH, NMATCH-NSVMAT
471 10000 FORMAT (I8, ' nodes matched', :, ', ', I8, ' this set')
472 CALL SQZSTR (STRING, LSTR)
473 WRITE (*, 10010) STRING(:LSTR)
474 IF (IEXPCT .NE. 0 .AND. IEXPCT .NE. NMATCH-NSVMAT) then
475 call prterr ('ERROR',
476 $ 'Expected number of matches not equal to actual')
477 STOP 'Node Match Error'
478 END IF
479 END IF
480 if (ncomp .gt. 0) then
481 if ((time2 - time1) .ne. 0.0) then
482 Write (*, 10055) Time2-Time1, NCOMP/(time2-time1)
483 else
484 write (*, 10060) Time2-Time1
485 end if
486 end if
487
488 RETURN
489 10010 FORMAT (/, 4X, A)
490 10020 FORMAT (' Number of equivalence comparisons = ',T38,I15,T60,I15)
491 10050 FORMAT (' Number of equivalence comparisons = ',T60,I15)
492 10021 FORMAT (' Tolerance used for matching = ',T60,1PE10.3)
493 10025 FORMAT (' Maximum distance between matched nodes = ',T60,
494 * 1PE10.3)
495 10030 FORMAT (' Minimum distance between nonmatched nodes = ',T60,
496 * 1PE10.3)
497 10035 FORMAT (' Equivalencing based on closest node within tolerance')
498 10055 FORMAT (' Cpu Time = ',1PE10.3, ', comparison/sec = ',1PE10.3)
499 10060 FORMAT (' Cpu Time = ',1PE10.3, ', comparison/sec = Infinite')
500 END