Debian Codegraph @

packages/seacas/applications/fastq/getang.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 GETANG (MXND, MLN, XN, YN, LNODES, LXK, KXL, NXL,
8 & LXN, I, J, K, ANGLE, ERR)
9 C***********************************************************************
10
11 C SUBROUTINE GETANG = RETURNS THE CCW ANGLE FROM A VECTOR DRAWN
12 C FROM NODE J TO K TO A VECTOR DRAWN
13 C FROM NODE J TO I
14
15 C***********************************************************************
16
17 DIMENSION LNODES (MLN, *)
18 DIMENSION XN (*), YN (*)
19 DIMENSION LXN(4, *), NXL(2, *)
20 DIMENSION LXK(4, *), KXL(2, *)
21
22 LOGICAL CORNP, SIDEP, DISCTP, ERR
23
24 C ... The save statement was added during debugging on the AMD Opteron
25 C system using the pgf77 5.1-3 compiler. Without the save, the
26 C code coredumps at line 120 if optimized.... Could not track
27 C down a problem, but adding the SAVE did work...
28
29 SAVE
30
31 TWOPI = 2.0 * ATAN2(0.0, -1.0)
32
33 IOPP = 0
34 KOPP = 0
35 I1 = 0
36 KK1 = 0
37
38 C CHECK FOR NODES ON TOP OF EACH OTHER
39
40 IF (((XN (J) .EQ. XN (K)) .AND. (YN (J) .EQ. YN (K)) ) .OR.
41 & ( (XN (I) .EQ. XN (J)) .AND. (YN (I) .EQ. YN (J)) ) .OR.
42 & ( (XN (I) .EQ. XN (K)) .AND. (YN (I) .EQ. YN (K)) ) ) THEN
43 ANGLE = 0.
44 GOTO 220
45 ENDIF
46
47 V1 = ATAN2 (YN (K)-YN (J), XN (K)-XN (J))
48 IF (V1 .LT. 0.) V1 = V1 + TWOPI
49 V2 = ATAN2 (YN (I)-YN (J), XN (I)-XN (J))
50 IF (V2 .LT. 0.) V2 = V2 + TWOPI
51 ANGLE = V2 - V1
52 IF (ANGLE .LT. 0.) ANGLE = ANGLE + TWOPI
53
54 C NOW CHECK TO MAKE SURE THAT THE ANGLE HAS NOT CROSSED THE PREVIOUS
55 C ELEMENTS SIDES
56
57 L1 = LNODES (5, I)
58 L2 = LNODES (5, J)
59 K1 = KXL (1, L1)
60 K2 = KXL (1, L2)
61 IF (K1 .EQ. K2) GOTO 210
62
63 C SEE IF L2 CROSSES INTO K1 - FIRST GET THE NODE OPPOSITE I
64 C AND THEN CHECK THE ANGLE FROM VECTOR J TO K AND VECTOR
65 C J TO IOPP AGAINST THE INTERNAL ANGLE - SMALLER AND IT HAS
66 C CROSSED OVER.
67
68 IF (K1 .NE. 0) THEN
69 DO 100 II = 1, 4
70 LTEST = LXK (II, K1)
71 IF (LTEST .NE. L1) THEN
72 IF (NXL (1, LTEST) .EQ. J) THEN
73 IOPP = NXL (2, LTEST)
74 L3 = LTEST
75 GOTO 110
76 ELSEIF (NXL (2, LTEST) .EQ. J) THEN
77 IOPP = NXL (1, LTEST)
78 L3 = LTEST
79 GOTO 110
80 ENDIF
81 ENDIF
82 100 CONTINUE
83
84 CALL MESSAGE('** PROBLEMS IN GETANG GETTING IOPP **')
85 ERR = .TRUE.
86 GOTO 220
87 110 CONTINUE
88
89 C NOW TEST FOR CROSS-OVER
90
91 V2OPP = ATAN2 (YN (IOPP) - YN (J), XN (IOPP) - XN (J))
92 IF (V2OPP .LT. 0.) V2OPP = V2OPP + TWOPI
93 ANGLE1 = V2OPP - V2
94 IF (ANGLE1 .LT. 0.) ANGLE1 = ANGLE1 + TWOPI
95 ANGLE2 = V2OPP - V1
96 IF (ANGLE2 .LT. 0.) ANGLE2 = ANGLE2 + TWOPI
97 IF (ANGLE2 .LE. ANGLE1) THEN
98 ANGLE = ANGLE - TWOPI
99 GOTO 210
100 ENDIF
101 END IF
102
103 C SEE IF L2 CROSSES INTO K1 - FIRST GET THE NODE OPPOSITE K
104 C AND THEN CHECK THE ANGLE FROM VECTOR J TO K AND VECTOR
105 C J TO IOPP AGAINST THE INTERNAL ANGLE - SMALLER AND IT HAS
106 C CROSSED OVER.
107
108 120 CONTINUE
109 IF (K2 .EQ. 0) GOTO 210
110 DO 130 II = 1, 4
111 LTEST = LXK (II, K2)
112 IF (LTEST .NE. L2) THEN
113 IF (NXL (1, LTEST) .EQ. J) THEN
114 KOPP = NXL (2, LTEST)
115 GOTO 140
116 ELSEIF (NXL (2, LTEST) .EQ. J) THEN
117 KOPP = NXL (1, LTEST)
118 GOTO 140
119 ENDIF
120 ENDIF
121 130 CONTINUE
122
123 CALL MESSAGE('** PROBLEMS IN GETANG GETTING KOPP **')
124 ERR = .TRUE.
125 GOTO 220
126 140 CONTINUE
127
128 C NOW TEST FOR CROSS-OVER
129
130 V1OPP = ATAN2 (YN (KOPP) - YN (J), XN (KOPP) - XN (J))
131 IF (V1OPP .LT. 0.) V1OPP = V1OPP + TWOPI
132 ANGLE1 = V1 - V1OPP
133 IF (ANGLE1 .LT. 0.) ANGLE1 = ANGLE1 + TWOPI
134 ANGLE2 = V2 - V1OPP
135 IF (ANGLE2 .LT. 0.) ANGLE2 = ANGLE2 + TWOPI
136 IF (ANGLE2 .LE. ANGLE1) THEN
137 ANGLE = ANGLE - TWOPI
138 GOTO 210
139 ENDIF
140
141 C NOW CHECK TO MAKE SURE THAT THE ANGLE HAS NOT CROSSED OVER TWO
142 C ELEMENT SIDES IF THE NODE IS ATTACHED TO 5 OR MORE LINES
143
144 IF (LXN (4, J) .LT. 0) THEN
145 K3 = KXL (1, L3) + KXL (2, L3) - K1
146 IF (K3 .EQ. K2) GOTO 210
147
148 C SEE IF L2 CROSSES INTO K3 - FIRST GET THE NODE OPPOSITE J
149 C AND THEN CHECK THE ANGLE FROM VECTOR J TO K AND VECTOR
150 C J TO IOPP AGAINST THE INTERNAL ANGLE - SMALLER AND IT HAS
151 C CROSSED OVER.
152
153 IF (K3 .EQ. 0) GOTO 120
154 DO 150 II = 1, 4
155 LTEST = LXK (II, K3)
156 IF (LTEST .NE. L3) THEN
157 IF (NXL (1, LTEST) .EQ. J) THEN
158 IOPP3 = NXL (2, LTEST)
159 GOTO 160
160 ELSEIF (NXL (2, LTEST) .EQ. J) THEN
161 IOPP3 = NXL (1, LTEST)
162 GOTO 160
163 ENDIF
164 ENDIF
165 150 CONTINUE
166
167 CALL MESSAGE('** PROBLEMS IN GETANG GETTING IOPP3 **')
168 ERR = .TRUE.
169 GOTO 220
170 160 CONTINUE
171
172 C NOW TEST FOR CROSS-OVER
173
174 V3OPP = ATAN2 (YN (IOPP3) - YN (J), XN (IOPP3) - XN (J))
175 IF (V3OPP .LT. 0.) V3OPP = V3OPP + TWOPI
176 ANGLE1 = V3OPP - V2
177 IF (ANGLE1 .LT. 0.) ANGLE1 = ANGLE1 + TWOPI
178 ANGLE2 = V3OPP - V1
179 IF (ANGLE2 .LT. 0.) ANGLE2 = ANGLE2 + TWOPI
180 IF (ANGLE2 .LE. ANGLE1) THEN
181 ANGLE = ANGLE - TWOPI
182 GOTO 210
183 ENDIF
184 ENDIF
185
186 C NOW CHECK FOR AN INVERTED THREE NODE ANGLE - VERY SPECIAL
187 C CASE THAT FALLS THROUGH THE PREVIOUS CHECK
188
189 IF (KOPP .EQ. IOPP) THEN
190 DO 170 II = 1, 4
191 LTEST = LXK (II, K1)
192 IF ( (NXL (1, LTEST) .EQ. IOPP) .AND.
193 & (NXL (2, LTEST) .NE. J) ) THEN
194 I1 = NXL (2, LTEST)
195 GOTO 180
196 ELSEIF ( (NXL (2, LTEST) .EQ. IOPP) .AND.
197 & (NXL (1, LTEST) .NE. J) ) THEN
198 I1 = NXL (1, LTEST)
199 GOTO 180
200 ENDIF
201 170 CONTINUE
202
203 CALL MESSAGE('** PROBLEMS IN GETANG GETTING I1 **')
204 GOTO 220
205 180 CONTINUE
206 DO 190 II = 1, 4
207 LTEST = LXK (II, K2)
208 IF ( (NXL (1, LTEST) .EQ. KOPP) .AND.
209 & (NXL (2, LTEST) .NE. J) ) THEN
210 KK1 = NXL (2, LTEST)
211 GOTO 200
212 ELSEIF ( (NXL (2, LTEST) .EQ. KOPP) .AND.
213 & (NXL (1, LTEST) .NE. J) ) THEN
214 KK1 = NXL (1, LTEST)
215 GOTO 200
216 ENDIF
217 190 CONTINUE
218
219 CALL MESSAGE('** PROBLEMS IN GETANG KK1 **')
220 GOTO 220
221 200 CONTINUE
222
223 C NOW TEST FOR INVERSION
224
225 VVJ = ATAN2 (YN (J) - YN (KOPP), XN (J) - XN (KOPP))
226 IF (VVJ .LT. 0.) VVJ = VVJ + TWOPI
227 VVI1 = ATAN2 (YN (I1) - YN (KOPP), XN (I1) - XN (KOPP))
228 IF (VVI1 .LT. 0.) VVI1 = VVI1 + TWOPI
229 VVK1 = ATAN2 (YN (KK1) - YN (KOPP), XN (KK1) - XN (KOPP))
230 IF (VVK1 .LT. 0.) VVK1 = VVK1 + TWOPI
231 ANGLE1 = VVI1 - VVK1
232 IF (ANGLE1 .LT. 0.) ANGLE1 = ANGLE1 + TWOPI
233 ANGLE2 = VVJ - VVK1
234 IF (ANGLE2 .LT. 0.) ANGLE2 = ANGLE2 + TWOPI
235 IF (ANGLE2 .GT. ANGLE1) THEN
236 ANGLE = ANGLE - TWOPI
237 ENDIF
238 ENDIF
239
240 C GET THE RIGHT CLASSIFICATION
241
242 210 CONTINUE
243 IF (CORNP (ANGLE)) THEN
244 IF (SIDEP (ANGLE)) THEN
245 LNODES (6, J) = 2
246 ELSE
247 LNODES (6, J) = 1
248 ENDIF
249 ELSEIF (SIDEP (ANGLE)) THEN
250 IF (DISCTP (ANGLE)) THEN
251 LNODES (6, J) = 4
252 ELSE
253 LNODES (6, J) = 3
254 ENDIF
255 ELSE
256 LNODES (6, J) = 5
257 ENDIF
258
259 220 CONTINUE
260 RETURN
261
262 END