Debian Codegraph @

packages/seacas/applications/fastq/picktr.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 SUBROUTINE PICKTR (NPER, X, Y, NID, ANGLE, HALFC, I1, I2, I3, I4,
8 & I5, I6, I7, I8)
9 C***********************************************************************
10
11 C SUBROUTINE PICKTR = DETERMINES A REASONABLE SHAPE FOR A BACK-TO-BACK
12 C SET OF TRIANGLES (TRANSITION REGION)
13
14 C***********************************************************************
15
16 PARAMETER (RLARGE = 1000000.)
17 DIMENSION X(NPER), Y(NPER), NID(NPER), ANGLE(NPER)
18 DIMENSION SMANG(7), INDEX(7)
19 DIMENSION ISORT(4)
20
21 LOGICAL HALFC
22
23 PI = ATAN2(0.0, -1.0)
24 PID2 = 0.5 * PI
25 TWOPI = 2.0 * PI
26
27 C FORM THE LIST OF SMALLEST ANGLES
28
29 NSA = 6
30 DO 100 I = 1, NSA
31 SMANG(I) = 10.
32 INDEX(I) = 0
33 100 CONTINUE
34
35 AGOLD = ATAN2 (Y (1) - Y (NPER), X (1) - X (NPER))
36
37 DO 130 J = 1, NPER
38
39 C GET THE ANGLE FORMED BY THIS SET OF POINTS
40
41 NEXT = J + 1
42 IF (NEXT .GT. NPER) NEXT = 1
43 AGNEW = ATAN2 (Y (NEXT) - Y (J), X (NEXT) - X (J))
44 DIFF = AGNEW - AGOLD
45 IF (DIFF .GT. PI) DIFF = DIFF - TWOPI
46 IF (DIFF .LT. - PI) DIFF = DIFF + TWOPI
47 ANGLE (J) = PI - DIFF
48 AGOLD = AGNEW
49
50 C SORT THIS ANGLE AGAINST PREVIOUS ANGLES TO SEE IF IT IS ONE OF
51 C THE SMALLEST
52
53 SMANG (NSA + 1) = ANGLE (J)
54 INDEX (NSA + 1) = J
55 DO 110 II = 1, NSA
56 I = NSA + 1 - II
57 IF (SMANG (I + 1) .GE. SMANG (I)) GO TO 120
58 TEMP = SMANG (I)
59 ITEMP = INDEX (I)
60 SMANG (I) = SMANG (I + 1)
61 INDEX (I) = INDEX (I + 1)
62 SMANG (I + 1) = TEMP
63 INDEX (I + 1) = ITEMP
64 110 CONTINUE
65 120 CONTINUE
66
67 130 CONTINUE
68
69 C DETERMINE TWO/FOUR BEST CORNER POINTS FOR SEMICIRCLE/TRANSITION REGION
70
71 ATOL = PI * 150. / 180.
72
73 C FIND SIDE DIVISION USING 4 SMALLEST ANGLES AND CHECK CONDITION
74
75 DO 140 I = 1, 4
76 ISORT (I) = INDEX (I)
77 140 CONTINUE
78 DO 160 I = 1, 3
79 DO 150 J = I + 1, 4
80 IF (ISORT (I) .GT. ISORT (J)) THEN
81 ITMP = ISORT (I)
82 ISORT (I) = ISORT (J)
83 ISORT (J) = ITMP
84 ENDIF
85 150 CONTINUE
86 160 CONTINUE
87 I1 = ISORT (1)
88 I2 = ISORT (2)
89 I3 = ISORT (3)
90 I4 = ISORT (4)
91 M1 = I2 - I1
92 IF (M1 .LT. 0) M1 = NPER + M1
93 M2 = I3 - I2
94 IF (M2 .LT. 0) M2 = NPER + M2
95 M3 = I4 - I3
96 IF (M3 .LT. 0) M3 = NPER + M3
97 M4 = NPER - M1 - M2 - M3
98
99 C USE THE LONGEST SIDE THAT DOES NOT HAVE OPPOSITE
100 C MATCHES AS THE CHOICE FOR THE BASE (OF TRANSITIONS)
101 C THE BASE MUST BE AT LEAST 4 INTERVALS LONG
102
103 IF ( (M1 .EQ. M3) .AND. (.NOT. HALFC)) THEN
104 MMAX = MAX0 (M2, M4)
105 IF (MMAX .GE. 4) THEN
106 IF (M2 .EQ. MMAX) THEN
107 IFIRST = I2
108 MBASE = M2
109 ELSE
110 IFIRST = I4
111 MBASE = M4
112 ENDIF
113 ENDIF
114 ELSEIF ( (M2 .EQ. M4) .AND. (.NOT. HALFC)) THEN
115 MMAX = MAX0 (M1, M3)
116 IF (MMAX .GE. 4) THEN
117 IF (M1 .EQ. MMAX) THEN
118 IFIRST = I1
119 MBASE = M1
120 ELSE
121 IFIRST = I3
122 MBASE = M3
123 ENDIF
124 ENDIF
125 ELSE
126 MMAX = MAX0 (M1, M2, M3, M4)
127 IF (MMAX .GE. 4) THEN
128 IF (M1 .EQ. MMAX) THEN
129 IFIRST = I1
130 MBASE = M1
131 ELSEIF (M2 .EQ. MMAX) THEN
132 IFIRST = I2
133 MBASE = M2
134 ELSEIF (M3 .EQ. MMAX) THEN
135 IFIRST = I3
136 MBASE = M3
137 ELSEIF (M4 .EQ. MMAX) THEN
138 IFIRST = I4
139 MBASE = M4
140 ENDIF
141 ENDIF
142 ENDIF
143 IF (MMAX .GE. 4) THEN
144 IF (HALFC) THEN
145 GBEST = ANGLE (I1) + ANGLE (I2) + ABS (PI - ANGLE (I3))
146 & + ABS (PI - ANGLE (I4))
147 ELSE
148 GBEST = ANGLE (I1) + ANGLE (I2) + ANGLE (I3) + ANGLE (I4)
149 ENDIF
150 ELSE
151 IFIRST = 1
152 GBEST = RLARGE
153 END IF
154
155 C GO AROUND THE PERIMETER USING THE 6 SMALLEST ANGLES AS POSSIBLE
156 C STARTING POINTS, AND THEN FIND THE BEST COMBINATION OF SIDE LENGTHS
157
158 DO 200 ISA = 1, NSA
159 IF (SMANG (ISA) .LE. ATOL) THEN
160 I1 = INDEX (ISA)
161 SUM1 = ANGLE (I1)
162 IF (HALFC) THEN
163 IF (SUM1 .GT. GBEST) GO TO 200
164 ELSE
165 IF (SUM1 .GE. GBEST) GO TO 200
166 ENDIF
167
168 C ASSIGN A TRIAL SECOND NODE
169
170 DO 190 N1 = 1, NPER - 4
171 I2 = I1 + N1
172 IF (I2 .GT. NPER) I2 = I2 - NPER
173 SUM2 = SUM1 + ANGLE (I2)
174 IF (HALFC) THEN
175 IF (SUM2 .GT. GBEST) GO TO 190
176 ELSE
177 IF (SUM2 .GE. GBEST) GO TO 190
178 ENDIF
179
180 C ASSIGN A TRIAL THIRD NODE
181
182 DO 180 N2 = 1, NPER - N1 - 3
183 I3 = I2 + N2
184 IF (I3 .GT. NPER) I3 = I3 - NPER
185 IF (HALFC) THEN
186 SUM3 = SUM2 + ABS (PI - ANGLE (I3))
187 ELSE
188 SUM3 = SUM2 + ANGLE (I3)
189 END IF
190 IF (HALFC) THEN
191 IF (SUM3 .GT. GBEST) GO TO 180
192 ELSE
193 IF (SUM3 .GE. GBEST) GO TO 180
194 ENDIF
195
196 C ASSIGN A TRIAL FOURTH NODE
197
198 DO 170 N3 = 1, NPER - N1 - N2 - 2
199 I4 = I3 + N3
200 IF (I4 .GT. NPER) I4 = I4 - NPER
201 IF (HALFC) THEN
202 GVAL = SUM3 + ABS (PI - ANGLE (I4))
203 ELSE
204 GVAL = SUM3 + ANGLE (I4)
205 END IF
206 IF (HALFC) THEN
207 IF (GVAL .GT. GBEST) GO TO 170
208 ELSE
209 IF (GVAL .GE. GBEST) GO TO 170
210 ENDIF
211
212 C FIND SIDE DIVISION AND CHECK CONDITION
213
214 M1 = I2 - I1
215 IF (M1 .LT. 0) M1 = NPER + M1
216 M2 = I3 - I2
217 IF (M2 .LT. 0) M2 = NPER + M2
218 M3 = I4 - I3
219 IF (M3 .LT. 0) M3 = NPER + M3
220 M4 = NPER - M1 - M2 - M3
221
222 C USE THE LONGEST SIDE THAT DOES NOT HAVE OPPOSITE
223 C MATCHES AS THE CHOICE FOR THE BASE (OF TRANSITIONS)
224 C THE BASE MUST BE AT LEAST 4 INTERVALS LONG
225
226 IF ( (M1 .EQ. M3) .AND. (.NOT. HALFC)) THEN
227 MMAX = MAX0 (M2, M4)
228 IF (MMAX .GE. 4) THEN
229 IF (M2 .EQ. MMAX) THEN
230 IFIRST = I2
231 MBASE = M2
232 ELSE
233 IFIRST = I4
234 MBASE = M4
235 ENDIF
236 ENDIF
237 ELSEIF ( (M2 .EQ. M4) .AND. (.NOT. HALFC)) THEN
238 MMAX = MAX0 (M1, M3)
239 IF (MMAX .GE. 4) THEN
240 IF (M1 .EQ. MMAX) THEN
241 IFIRST = I1
242 MBASE = M1
243 ELSE
244 IFIRST = I3
245 MBASE = M3
246 ENDIF
247 ENDIF
248 ELSE
249 MMAX = MAX0 (M1, M2, M3, M4)
250 IF (MMAX .GE. 4) THEN
251 IF (M1 .EQ. MMAX) THEN
252 IFIRST = I1
253 MBASE = M1
254 ELSEIF (M2 .EQ. MMAX) THEN
255 IFIRST = I2
256 MBASE = M2
257 ELSEIF (M3 .EQ. MMAX) THEN
258 IFIRST = I3
259 MBASE = M3
260 ELSEIF (M4 .EQ. MMAX) THEN
261 IFIRST = I4
262 MBASE = M4
263 ENDIF
264 ENDIF
265 IF (MMAX .GE. 4)GBEST = GVAL
266 ENDIF
267 170 CONTINUE
268 180 CONTINUE
269 190 CONTINUE
270 ENDIF
271 200 CONTINUE
272
273 C ROTATE THE PERIMETER AND THE ANGLES SO THE BASE LEADS THE LIST
274
275 IF (IFIRST .NE. 1) CALL FQ_ROTATE (NPER, X, Y, NID, IFIRST)
276 DO 220 I = 1, IFIRST - 1
277 AHOLD = ANGLE (1)
278 DO 210 J = 1, NPER - 1
279 ANGLE (J) = ANGLE (J + 1)
280 210 CONTINUE
281 ANGLE (NPER) = AHOLD
282 220 CONTINUE
283
284 C DECIDE THE TRIANGLE CORNERS
285
286 GBEST = RLARGE
287
288 C PICK AN ARBITRARY BASE CENTER (I3)
289
290 DO 250 I = 3, MBASE - 1
291
292 C FOR THIS BASE CENTER, PICK AN ARBITRARY I2 LOCATION
293
294 DO 240 J = 2, I - 1
295
296 C FOR THIS COMBINATION OF I3 AND I2, PICK AN ARBITRARY I4 LOCATION
297
298 DO 230 K = I + 1, MBASE
299
300 C CALCULATE I6 AND I8 AND ADD ANGLES TO FIND MINIMUM SUM
301
302 KN = MBASE + 1 - K
303 KK = I - J
304 KL = J - 1
305 KM = K - I
306 MLEFT = NPER - MBASE
307 KO = (MLEFT - KN + KL - KK - KM) / 2
308 KP = KN + KO - KL
309
310 C PROTECT AGAINST THE IMPOSSIBLE LENGTH PROBLEMS
311 C AND THE ODD NUMBER IN THE PERIMETER INPUT ERRORS
312
313 IF ( (KO .GT. 0) .AND. (KP .GT. 0)) THEN
314 IF (KP + KL .EQ. KN + KO) THEN
315
316 C NOW GET THE END POINTS GIVEN THESE SIDE LENGTHS
317
318 J6 = MBASE + 1 + KO
319 J7 = MBASE + 1 + KO + KM
320 J8 = MBASE + 1 + KO + KM + KK
321
322 C GET THE BASE ANGLE OF THE DIVIDER LINE
323
324 THETA1 = ATAN2 (Y (I + 1) - Y (I),
325 & X (I + 1) - X (I))
326 THETA2 = ATAN2 (Y (J7) - Y (I), X (J7) - X (I))
327 THETAB = ABS (THETA2 - THETA1)
328 IF (THETAB .GT. PI) THETAB = THETAB - PI
329 IF (THETAB .LT. PID2) THETAB = PI - THETAB
330
331 C GET THE TOP ANGLE OF THE DIVIDER LINE
332
333 THETA1 = ATAN2 (Y (J7 + 1) - Y (J7),
334 & X (J7 + 1) - X (J7))
335 THETAT = ABS (THETA2 - THETA1)
336 IF (THETAT .GT. PI) THETAT = THETAT - PI
337 IF (THETAT .LT. PID2) THETAT = PI - THETAT
338
339 C ADD THESE TO GET THE VALUE OF GVAL
340
341 IF (HALFC) THEN
342 GVAL = THETAB + THETAT + ABS (PI - ANGLE (J6))
343 & + ABS (PI - ANGLE (J8)) +
344 & (.1 * MAX0 (ABS (KK - KL),
345 & ABS (KM - KN)) / NPER)
346 ELSE
347 GVAL = ANGLE (J6) + ANGLE (J8) + THETAB + THETAT
348 ENDIF
349 IF (GVAL .LT. GBEST) THEN
350 GBEST = GVAL
351 I1 = 1
352 I2 = J
353 I3 = I
354 I4 = K
355 I5 = MBASE + 1
356 I6 = I5 + KO
357 I7 = I6 + KM
358 I8 = I7 + KK
359 ENDIF
360 ELSE
361 CALL MESSAGE('ODD PERIMETER PROBLEMS')
362 ENDIF
363 ENDIF
364 230 CONTINUE
365 240 CONTINUE
366 250 CONTINUE
367 RETURN
368 END