Debian Codegraph @

packages/seacas/applications/fastq/dline.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 DLINE (MP, ML, COOR, LINKP, KNUM, KT, IP1, IP2, IP3,
8 & NUMPLT, X1, Y1, TEST, GETMAX, XMIN, XMAX, YMIN, YMAX)
9 C***********************************************************************
10
11 C SUBROUTINE DLINE = DRAWS A LINE ACCORDING TO THE CURRENT DEFINITION
12 C OR SIMPLY GETS THE MAX/MIN FOR LINES GETMAX=.TRUE.
13
14 C***********************************************************************
15
16 C VARIABLES USED:
17 C IP1 = POINTER FOR THE FIRST POINT
18 C IP2 = POINTER FOR THE SECOND POINT
19 C IP3 = POINTER FOR THE THIRD POINT
20
21 C***********************************************************************
22
23 DIMENSION COOR (2, MP), LINKP (2, MP)
24
25 CHARACTER*72 DUMMY
26
27 LOGICAL NUMPLT, ADDLNK, TEST, GETMAX, ERR
28
29 PI = ATAN2(0.0, -1.0)
30
31 IF (TEST)WRITE (12, 10000)'SP', KNUM, ';'
32 ADDLNK = .FALSE.
33
34 C DEFINE FIRST POINT EXACTLY AND BRANCH
35
36 CALL LTSORT (MP, LINKP, IP1, IPNTR1, ADDLNK)
37 CALL LTSORT (MP, LINKP, IP2, IPNTR2, ADDLNK)
38 IF ((IPNTR1 .LE. 0).OR. (IPNTR2 .LE. 0))GOTO 140
39 IF (IP3 .NE. 0) THEN
40 CALL LTSORT (MP, LINKP, IABS (IP3), IPNTR3, ADDLNK)
41 IF (IPNTR3 .LE. 0)GOTO 140
42 ELSE
43 IPNTR3 = 0
44 ENDIF
45 X1 = COOR (1, IPNTR1)
46 Y1 = COOR (2, IPNTR1)
47
48 C STRAIGHT LINE GENERATION
49
50 IF (KT .EQ. 1) THEN
51 X2 = COOR (1, IPNTR2)
52 Y2 = COOR (2, IPNTR2)
53 IF (GETMAX) THEN
54 XMAX = AMAX1 (X1, X2, XMAX)
55 YMAX = AMAX1 (Y1, Y2, YMAX)
56 XMIN = AMIN1 (X1, X2, XMIN)
57 YMIN = AMIN1 (Y1, Y2, YMIN)
58 GOTO 140
59 ENDIF
60 XMID = (X1 + X2) * .5
61 YMID = (Y1 + Y2) * .5
62
63 C CORNER GENERATION
64
65 ELSEIF (KT .EQ. 2) THEN
66 X2 = COOR (1, IPNTR3)
67 Y2 = COOR (2, IPNTR3)
68 IF (GETMAX) THEN
69 XMAX = AMAX1 (X1, X2, COOR (1, IPNTR2), XMAX)
70 YMAX = AMAX1 (Y1, Y2, COOR (2, IPNTR2), YMAX)
71 XMIN = AMIN1 (X1, X2, COOR (1, IPNTR2), XMIN)
72 YMIN = AMIN1 (Y1, Y2, COOR (2, IPNTR2), YMIN)
73 GOTO 140
74 ENDIF
75 IF (TEST)WRITE (12, 10010)
76 & 'PU;PA', INT (X1 * 1000.), ', ',
77 & INT (Y1 * 1000.), ';PD;PA',
78 & INT (X2 * 1000.), ', ', INT (Y2 * 1000.), ';'
79 CALL MPD2VC (1, X1, Y1, X2, Y2)
80 XMID = X1 + ((X2 - X1) * .25)
81 YMID = Y1 + ((Y2 - Y1) * .25)
82 X1 = X2
83 Y1 = Y2
84 X2 = COOR (1, IPNTR2)
85 Y2 = COOR (2, IPNTR2)
86
87 C CIRCULAR ARC GENERATION
88
89 ELSEIF ((KT .EQ. 3).OR. (KT .EQ. 4).OR. (KT .EQ. 6)) THEN
90 CALL ARCPAR (MP, KT, KNUM, COOR, LINKP, IPNTR1, IPNTR2,
91 & IPNTR3, IP3, XCEN, YCEN, THETA1, THETA2, TANG, R1, R2, ERR,
92 & IDUM1, IDUM2, XK, XA)
93 IF (ERR) GOTO 140
94
95 C GENERATE THE CIRCLE
96
97 ANG = THETA1
98 DARC = .10
99 INC = INT (ABS (TANG) / DARC) + 1
100 IF (INC .LE. 6)INC = 6
101 DEL = TANG * (1.0 / DBLE(INC))
102 IEND = INC - 1
103 XK = (LOG (R2 / R1)) / (THETA2 - THETA1)
104 XA = R2 / EXP (XK * THETA2)
105 IF (GETMAX) THEN
106 XMAX = AMAX1 (X1, XMAX)
107 YMAX = AMAX1 (Y1, YMAX)
108 XMIN = AMIN1 (X1, XMIN)
109 YMIN = AMIN1 (Y1, YMIN)
110 ENDIF
111 DO 100 I = 1, IEND
112 ANG = ANG + DEL
113 RADIUS = XA * EXP (XK * ANG)
114 X2 = XCEN + COS (ANG) * RADIUS
115 Y2 = YCEN + SIN (ANG) * RADIUS
116 IF (GETMAX) THEN
117 XMAX = AMAX1 (X2, XMAX)
118 YMAX = AMAX1 (Y2, YMAX)
119 XMIN = AMIN1 (X2, XMIN)
120 YMIN = AMIN1 (Y2, YMIN)
121 ELSE
122 CALL MPD2VC (1, X1, Y1, X2, Y2)
123 ENDIF
124 IF (TEST)WRITE (12, 10010)
125 & 'PU;PA', INT (X1 * 1000.), ', ',
126 & INT (Y1 * 1000.), ';PD;PA',
127 & INT (X2 * 1000.), ', ', INT (Y2 * 1000.), ';'
128 X1 = X2
129 Y1 = Y2
130 IF (I .EQ. INC / 2) THEN
131 XMID = X1
132 YMID = Y1
133 ENDIF
134 100 CONTINUE
135
136 C ELIPSE GENERATION
137
138 ELSEIF (KT .EQ. 7) THEN
139 CALL ELPSPR (MP, KT, KNUM, COOR, LINKP, IPNTR1, IPNTR2, IPNTR3,
140 & IP3, XCEN, YCEN, THETA1, THETA2, TANG, IDUM1, IDUM2, AVALUE,
141 & BVALUE, ERR)
142 IF (ERR) GOTO 140
143
144 C GENERATE THE ELIPSE
145
146 IF (GETMAX) THEN
147 XMAX = AMAX1 (X1, XMAX)
148 YMAX = AMAX1 (Y1, YMAX)
149 XMIN = AMIN1 (X1, XMIN)
150 YMIN = AMIN1 (Y1, YMIN)
151 ENDIF
152 DARC = .10
153 INC = MAX0 (INT (ABS (TANG) / DARC) + 1, 15)
154 DEL = TANG * (1.0 / DBLE(INC))
155 IEND = INC - 1
156 ANG = THETA1
157 DO 110 I = 1, IEND
158 ANG = ANG + DEL
159 RADIUS = SQRT ( (AVALUE **2 * BVALUE **2) /
160 & ( (BVALUE **2 * COS (ANG) **2) +
161 & (AVALUE **2 * SIN (ANG) **2) ) )
162 X2 = XCEN + COS (ANG) * RADIUS
163 Y2 = YCEN + SIN (ANG) * RADIUS
164 IF (GETMAX) THEN
165 XMAX = AMAX1 (X2, XMAX)
166 YMAX = AMAX1 (Y2, YMAX)
167 XMIN = AMIN1 (X2, XMIN)
168 YMIN = AMIN1 (Y2, YMIN)
169 ELSE
170 CALL MPD2VC (1, X1, Y1, X2, Y2)
171 ENDIF
172 IF (TEST)WRITE (12, 10010)
173 & 'PU;PA', INT (X1 * 1000.), ', ',
174 & INT (Y1 * 1000.), ';PD;PA',
175 & INT (X2 * 1000.), ', ', INT (Y2 * 1000.), ';'
176 X1 = X2
177 Y1 = Y2
178 IF (I .EQ. INC / 2) THEN
179 XMID = X1
180 YMID = Y1
181 ENDIF
182 110 CONTINUE
183
184 C PARABOLA
185
186 ELSEIF (KT .EQ. 5) THEN
187 N = 50
188 FAC = 1.
189 DFF = .02
190
191 C CHECK LEGITIMACY OF DATA
192
193 XMID = (COOR (1, IPNTR1) + COOR (1, IPNTR2)) * 0.5
194 YMID = (COOR (2, IPNTR1) + COOR (2, IPNTR2)) * 0.5
195 DOT = (COOR (1, IPNTR2) - COOR (1, IPNTR1)) *
196 & (COOR (1, IPNTR3) - XMID) + (COOR (2, IPNTR2) -
197 & COOR (2, IPNTR1)) * (COOR (2, IPNTR3) - YMID)
198 PERP = SQRT ((COOR (1, IPNTR2) - COOR (1, IPNTR1)) **2 +
199 & (COOR (2, IPNTR2) - COOR (2, IPNTR1)) **2) *
200 & SQRT ((COOR (1, IPNTR3) - XMID) **2 +
201 & (COOR (2, IPNTR3) - YMID) **2)
202 IF (DOT .GE. 0.05 * PERP) THEN
203 CALL PLTFLU
204 WRITE (*, 10040)KNUM
205 GOTO 140
206 ENDIF
207 IF (GETMAX) THEN
208 XMAX = AMAX1 (X1, XMAX)
209 YMAX = AMAX1 (Y1, YMAX)
210 XMIN = AMIN1 (X1, XMIN)
211 YMIN = AMIN1 (Y1, YMIN)
212 ENDIF
213
214 C GET ARC LENGTH
215
216 HALFW = SQRT ((COOR (1, IPNTR2) - COOR (1, IPNTR1)) **2 +
217 & (COOR (2, IPNTR2) - COOR (2, IPNTR1)) **2) * 0.5
218 IF (HALFW .EQ. 0.) THEN
219 CALL PLTFLU
220 WRITE (*, 10020)KNUM
221 GOTO 140
222 ENDIF
223 HEIGHT = SQRT ((XMID - COOR (1, IPNTR3)) **2 + (YMID -
224 & COOR (2, IPNTR3)) **2)
225 COEF = HEIGHT / HALFW **2
226 TCOEF = 2.0 * COEF
227
228 C PARC IS A STATEMENT FUNCTION
229
230 PLEFT = PARC ( - TCOEF * HALFW, TCOEF)
231 ARCTOT = 2.0 * PARC (TCOEF * HALFW, TCOEF)
232 ARCDEL = DFF * ARCTOT
233 ARCNXT = ARCDEL
234 ARCNOW = 0.0
235 THETA = ATAN2 (COOR (2, IPNTR2) - COOR (2, IPNTR1),
236 & COOR (1, IPNTR2) - COOR (1, IPNTR1))
237
238 C CORRECT FOR ORIENTATION
239
240 CROSS = (COOR (1, IPNTR3) - XMID) * (COOR (2, IPNTR2) -
241 & COOR (2, IPNTR1)) - (COOR (2, IPNTR3) - YMID) *
242 & (COOR (1, IPNTR2) - COOR (1, IPNTR1))
243 IF (CROSS .LT. 0.0)THETA = THETA + PI
244 SINT = SIN (THETA)
245 COST = COS (THETA)
246
247 C FIND POINTS APPROXIMATELY BY INTEGRATION
248
249 XL = - HALFW
250 FL = SQRT (1.0 + (TCOEF * XL) **2)
251 KOUNT = 1
252 DELX = 2.0 * HALFW / 200.0
253 DO 120 I = 1, 100
254 FM = SQRT (1.0 + (TCOEF * (XL + DELX)) **2)
255 XR = - HALFW + DBLE(I) * 2.0 * DELX
256 FR = SQRT (1.0 + (TCOEF * XR) **2)
257 ARCOLD = ARCNOW
258 ARCNOW = ARCNOW + DELX * (FL + 4.0 * FM + FR) / 3.0
259 IF (ARCNOW .GE. ARCNXT) THEN
260
261 C COMPUTE POSITION IN LOCAL COORDINATE SYSTEM
262
263 FRAC = (ARCNXT - ARCOLD) / (ARCNOW - ARCOLD)
264 XK = XL + FRAC * 2.0 * DELX
265 YK = COEF * XK **2
266
267 C CORRECT FOR ORIENTATION PROBLEM
268
269 IF (CROSS .LT. 0.0)XK = - XK
270
271 C ROTATE IN LINE WITH GLOBAL COORDINATE SYSTEM
272
273 ROTX = XK * COST - YK * SINT
274 ROTY = YK * COST + XK * SINT
275
276 C RESTORE XK
277
278 IF (CROSS .LT. 0.0)XK = - XK
279
280 C TRANSLATE
281
282 KOUNT = KOUNT + 1
283 X2 = ROTX + COOR (1, IPNTR3)
284 Y2 = ROTY + COOR (2, IPNTR3)
285 IF (TEST)WRITE (12, 10010)
286 & 'PU;PA', INT (X1 * 1000.), ', ',
287 & INT (Y1 * 1000.), ';PD;PA',
288 & INT (X2 * 1000.), ', ', INT (Y2 * 1000.), ';'
289 IF (GETMAX) THEN
290 XMAX = AMAX1 (X2, XMAX)
291 YMAX = AMAX1 (Y2, YMAX)
292 XMIN = AMIN1 (X2, XMIN)
293 YMIN = AMIN1 (Y2, YMIN)
294 ELSE
295 CALL MPD2VC (1, X1, Y1, X2, Y2)
296 ENDIF
297 X1 = X2
298 Y1 = Y2
299
300 C PREPARE FOR NEXT POINT
301
302 IF (KOUNT .GE. N - 1)GOTO 130
303 ARCDEL = ARCDEL * FAC
304 ARCNXT = ARCNXT + ARCDEL
305
306 C RESTART INTEGRATION
307
308 XR = XK
309 FR = SQRT (1.0 + (TCOEF * XR) **2)
310
311 C CORRECT FOR INTEGRATION ERROR
312
313 ARCNOW = PARC (TCOEF * XR, TCOEF) - PLEFT
314 ENDIF
315 XL = XR
316 FL = FR
317 120 CONTINUE
318 130 CONTINUE
319 XMID = COOR (1, IPNTR3)
320 YMID = COOR (2, IPNTR3)
321 ENDIF
322
323 C NORMAL EXIT
324 C DEFINE LAST POINT EXACTLY
325
326 X2 = COOR (1, IPNTR2)
327 Y2 = COOR (2, IPNTR2)
328 IF (GETMAX) THEN
329 XMAX = AMAX1 (X2, XMAX)
330 YMAX = AMAX1 (Y2, YMAX)
331 XMIN = AMIN1 (X2, XMIN)
332 YMIN = AMIN1 (Y2, YMIN)
333 GOTO 140
334 ENDIF
335 IF (TEST)WRITE (12, 10010)
336 & 'PU;PA', INT (X1 * 1000.), ', ',
337 & INT (Y1 * 1000.), ';PD;PA',
338 & INT (X2 * 1000.), ', ', INT (Y2 * 1000.), ';'
339 CALL MPD2VC (1, X1, Y1, X2, Y2)
340 CALL PLTFLU
341
342 C PLOT THE LINE NUMBER IF DESIRED
343
344 IF (KNUM .GT. 0) THEN
345 CALL MP2PT (1, XMID, YMID, X1, Y1, MASK)
346 IF ((MOD (MASK, 2) .NE. 0).AND. (NUMPLT)) THEN
347 CALL GETDUM (KNUM, DUMMY, LEN)
348 CALL PLTXTH (X1, Y1, DUMMY (1:LEN))
349 ENDIF
350 ENDIF
351
352 140 CONTINUE
353
354 RETURN
355
356 10000 FORMAT (A2, I6, A1)
357 10010 FORMAT (A5, I10, A1, I10, A6, I10, A1, I10, A1)
358 10020 FORMAT (' ZERO LINE LENGTH ENCOUNTERED FOR LINE', I5)
359 10040 FORMAT (' POINTS GIVEN FOR LINE', I5, ' DO NOT DEFINE A PARABOLA')
360
361 END