Debian Codegraph @

packages/seacas/applications/fastq/midnod.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 MIDNOD (NPNODE, NNUID, NPELEM, NNXK, MP, ML, KKK, NNN,
8 & NALL, NL, NXK, NUID, XN, YN, LISTN, COOR, ILINE, LTYPE, LCON,
9 & LINKP, LINKL, THREE, EIGHT, NINE)
10 C***********************************************************************
11
12 C SUBROUTINE MIDNOD = GENERATES THE MIDSIDE NODE FOR ELEMENTS
13
14 C***********************************************************************
15
16 DIMENSION XN (NPNODE), YN (NPNODE)
17 DIMENSION NUID (NNUID), NXK (NNXK, NPELEM)
18 DIMENSION LISTN (NNUID)
19 DIMENSION COOR (2, MP), ILINE (ML), LTYPE (ML), LCON (3, ML)
20 DIMENSION LINKP (2, MP), LINKL (2, ML)
21
22 LOGICAL ADDLNK, THREE, EIGHT, NINE, ITSOK
23
24 PI = ATAN2(0.0, -1.0)
25 TUPI = 2.0 * PI
26
27 ADDLNK = .FALSE.
28
29 NALL = NNN
30 DO 130 J = 1, KKK
31 DO 120 I = 1, 4
32
33 C SKIP DUPLICATE DESCRIPTORS AND ELEMENTS THAT ARE NOT TO
34 C HAVE MIDSIDE NODES
35
36 IF (NXK (I, J) .LT. 0) THEN
37
38 C THIS ELEMENT IS A BAR ELEMENT
39
40 IF (NXK (3, J) .EQ. 0) THEN
41 IF (THREE) THEN
42 ITSOK = .TRUE.
43 ELSE
44 ITSOK = .FALSE.
45 ENDIF
46
47 C THIS ELEMENT IS A QUAD ELEMENT
48
49 ELSEIF ((EIGHT) .OR. (NINE)) THEN
50 ITSOK = .TRUE.
51 ELSE
52 ITSOK = .FALSE.
53 ENDIF
54 ELSE
55 ITSOK = .FALSE.
56 ENDIF
57
58 C GENERATE THE MIDSIDE NODE IF APPROPRIATE
59
60 IF (ITSOK) THEN
61 II = I + 1
62 IF (I .GE. 4)II = 1
63 NODEA = IABS (NXK (I, J))
64 NODEB = IABS (NXK (II, J))
65
66 C CHECK TO SEE IF THE ELEMENT IS A BARSET
67
68 IF ((NODEA .GT. 0) .AND. (NODEB .GT. 0)) THEN
69 NUIDA = NUID (NODEA)
70 NUIDB = NUID (NODEB)
71
72 C IF ONE NODE OR THE OTHER IS INTERIOR, USE LINEAR INTERPOLATION
73
74 IF ( ((NUIDA .GT. 100000) .AND.
75 & (NUIDA .LT. 1000000000)) .OR.
76 & ((NUIDB .GT. 100000) .AND.
77 & (NUIDB .LT. 1000000000)) ) THEN
78 XINT = 0.5 * (XN (NODEA) + XN (NODEB))
79 YINT = 0.5 * (YN (NODEA) + YN (NODEB))
80
81 C BOTH ARE POINT OR LINE NODES.
82 C FIND THE LINE THAT THEY BELONG TO
83
84 ELSE
85 LTEST = 0
86
87 C SEE IF ONE IS NOT THE END POINT OF A LINE
88 C THEN CHECK THE OTHER TO SEE IF IT IS ON THE SAME LINE
89 C IF IT IS NOT ON THE SAME LINE, THEN USE LINEAR INTERPOLATION
90
91 IF (NUIDA .GT. 1000000000) THEN
92 LTEST = (NUIDA - 1000000000) / 100000
93 CALL LTSORT (ML, LINKL, LTEST, LT, ADDLNK)
94 IF (NUIDB .GT. 1000000000) THEN
95 LNEW = (ABS (NUIDB) - 1000000000) / 100000
96 IF (LNEW.NE.LTEST)LTEST = 0
97 ELSE
98 IF ((LCON (1, LT) .NE. NUIDB) .AND.
99 & (LCON (2, LT) .NE. NUIDB)) LTEST = 0
100 ENDIF
101 ELSEIF (NUIDB .GT. 1000000000) THEN
102 LTEST = (NUIDB - 1000000000) / 100000
103 CALL LTSORT (ML, LINKL, LTEST, LT, ADDLNK)
104 IF (NUIDA .GT. 1000000000) THEN
105 LNEW = (ABS (NUIDA) - 1000000000) / 100000
106 IF (LNEW .NE. LTEST) LTEST = 0
107 ELSE
108 IF ((LCON (1, LT) .NE. NUIDA) .AND.
109 & (LCON (2, LT) .NE. NUIDA)) LTEST = 0
110 ENDIF
111 ELSE
112
113 C BOTH ARE END POINTS OF LINES - SEE IF THEY ARE ON THE SAME LINE
114
115 NSUM = ABS (NUIDA) + ABS (NUIDB)
116 DO 100 L = 1, NL
117 CALL LTSORT (ML, LINKL, ILINE (L), K, ADDLNK)
118 IF ((LCON (1, K) + LCON (2, K)) .EQ. NSUM)
119 & THEN
120 IF ( ((LCON (1, K) .EQ. ABS (NUIDA)) .AND.
121 & (LCON (2, K) .EQ. ABS (NUIDB))) .OR.
122 & ((LCON (1, K) .EQ. ABS (NUIDB)) .AND.
123 & (LCON (2, K) .EQ. ABS (NUIDA)))) THEN
124 LTEST = ILINE (L)
125 GOTO 110
126 ENDIF
127 ENDIF
128 100 CONTINUE
129 110 CONTINUE
130 ENDIF
131
132 C IF THEY ARE NOT ON THE SAME LINE, IT IS NOT IN ERROR
133 C THEY SPAN A SINGLE WIDTH REGION
134 C ASSUME LINEAR INTERPOLATION
135
136 IF (LTEST .EQ. 0) THEN
137 KT = 0
138 ELSE
139 CALL LTSORT (ML, LINKL, LTEST, LT, ADDLNK)
140 KT = LTYPE (LT)
141 ENDIF
142
143 C CALCULATE THE MID-SIDE NODE BY LINEAR INTERPOLATION
144 C IF THE LINE TYPE IS STRAIGHT OR CORNER OR THE 2 END POINTS
145 C SPAN A SINGLE WIDTH REGION
146
147 IF (KT .LT. 3) THEN
148 XINT = 0.5 * (XN (NODEA) + XN (NODEB))
149 YINT = 0.5 * (YN (NODEA) + YN (NODEB))
150
151 C IF THE LINE IS A CIRCLE OR PARABOLA, GENERATE THE MID-POINT BY USING
152 C THE 2 NODES AS ARC ENDPOINTS AND AN INTERVAL OF 2 FOR THE LINE.
153 C THE CENTER OF THE LINE MUST BE FOUND FROM THE LINE CARD ITSELF.
154
155 ELSE
156 CALL LTSORT (MP, LINKP, LCON (1, LT), IP1,
157 & ADDLNK)
158 CALL LTSORT (MP, LINKP, LCON (2, LT), IP2,
159 & ADDLNK)
160 IF (LCON (3, LT) .GT. 0) THEN
161 CALL LTSORT (MP, LINKP, LCON (3, LT), IP3,
162 & ADDLNK)
163 ELSEIF (LCON (3, LT) .LT. 0) THEN
164 CALL LTSORT (MP, LINKP, IABS (LCON (3, LT)),
165 & IP3, ADDLNK)
166 IP3 = - IP3
167 ELSE
168 IP3 = 0
169 ENDIF
170
171 C ARC WITH CENTER GIVEN
172 C ARC GOES FROM 1ST POINT TO 2ND IN *COUNTER-CLOCKWISE* DIRECTION.
173
174 IF (KT .EQ. 3) THEN
175 XCEN = COOR (1, IABS (IP3))
176 YCEN = COOR (2, IABS (IP3))
177
178 C CIRCLE WITH THIRD POINT ON ARC.
179
180 ELSEIF (KT .EQ. 4) THEN
181 THETA1 = ATAN2 (COOR (2, IP3) -
182 & COOR (2, IP1), COOR (1, IP3) -
183 & COOR (1, IP1)) + PI / 2.0
184 THETA2 = ATAN2 (COOR (2, IP3) -
185 & COOR (2, IP2), COOR (1, IP3) -
186 & COOR (1, IP2)) + PI / 2.0
187 DET = - COS (THETA1) * SIN (THETA2) +
188 & COS (THETA2) * SIN (THETA1)
189 X1 = 0.5 * (COOR (1, IP1) + COOR (1, IP3))
190 Y1 = 0.5 * (COOR (2, IP1) + COOR (2, IP3))
191 X2 = 0.5 * (COOR (1, IP2) + COOR (1, IP3))
192 Y2 = 0.5 * (COOR (2, IP2) + COOR (2, IP3))
193 R = ( - SIN (THETA2) * (X2 - X1) +
194 & COS (THETA2) * (Y2 - Y1)) / DET
195 XCEN = X1 + R * COS (THETA1)
196 YCEN = Y1 + R * SIN (THETA1)
197
198 C PARABOLA WITH CENTER GIVEN
199
200 ELSEIF (KT .EQ. 5) THEN
201 XCEN = COOR (1, IABS (IP3))
202 YCEN = COOR (2, IABS (IP3))
203
204 C CIRCLE WITH RADIUS GIVEN
205
206 ELSEIF (KT .EQ. 6) THEN
207 DX = 0.5 * (COOR (1, IP2) - COOR (1, IP1))
208 DY = 0.5 * (COOR (2, IP2) - COOR (2, IP1))
209 CHORD = SQRT (DX * DX + DY * DY)
210 R = ABS (COOR (1, IABS (IP3)))
211 IF (R.LE.CHORD) THEN
212 XCEN = 0.5 * (COOR (1, IP1) +
213 & COOR (1, IP2))
214 YCEN = 0.5 * (COOR (2, IP1) +
215 & COOR (2, IP2))
216 ELSE
217 ARM = SQRT (R * R - CHORD * CHORD)
218 ENDIF
219 IF (IP3 .LT. 0) THEN
220 XCEN = COOR (1, IP1) + DX +
221 & ARM * DY / CHORD
222 YCEN = COOR (2, IP1) + DY -
223 & ARM * DX / CHORD
224 ELSE
225 XCEN = COOR (1, IP1) + DX -
226 & ARM * DY / CHORD
227 YCEN = COOR (2, IP1) + DY +
228 & ARM * DX / CHORD
229 ENDIF
230 ENDIF
231
232 C CALCULATE THE MIDPOINT ON THE ARC
233
234 R1 = SQRT ((XN (NODEA) - XCEN) **2 +
235 & (YN (NODEA) - YCEN) **2)
236 R2 = SQRT ((XN (NODEB) - XCEN) **2 +
237 & (YN (NODEB) - YCEN) **2)
238 RM = (R1 + R2) * .5
239 THETA1 = ATAN2 (YN (NODEA) - YCEN,
240 & XN (NODEA) - XCEN)
241 IF (THETA1 .LT. 0)THETA1 = THETA1 + TUPI
242 THETA2 = ATAN2 (YN (NODEB) - YCEN,
243 & XN (NODEB) - XCEN)
244 IF (THETA2 .LT. 0)THETA2 = THETA2 + TUPI
245 THETAM = (THETA1 + THETA2) * .5
246 IF (ABS (THETA1 - THETA2) .GT. PI)
247 & THETAM = THETAM + PI
248 XINT = COS (THETAM) * RM + XCEN
249 YINT = SIN (THETAM) * RM + YCEN
250 ENDIF
251 ENDIF
252
253 C ADD THIS NEW NODE TO THE NODE LIST.
254
255 IF (NALL .GE. NPNODE) THEN
256 WRITE (*, 10000)NPNODE
257 GOTO 140
258 ENDIF
259 NALL = NALL + 1
260 NLO = MIN0 (NODEA, NODEB)
261 NHI = MAX0 (NODEA, NODEB)
262 LISTN (NALL) = NLO * 100000 + NHI
263 XN (NALL) = XINT
264 YN (NALL) = YINT
265 ENDIF
266 ENDIF
267 120 CONTINUE
268 130 CONTINUE
269
270 140 CONTINUE
271 RETURN
272
273 10000 FORMAT (' NODE ARRAY OVERFLOW IN MIDNOD', /
274 & ' THERE ARE MORE THAN', I5, ' NODES IN THE MESH')
275
276 END