Debian Codegraph @

packages/seacas/applications/gen3d/g3_arcxyz.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=======================================================================
8 SUBROUTINE ARCXYZ (XN, YN, XN3, YN3, ZN3, IXNP, NRNP, NPCEN,
9 & SINANG, COSANG)
10 C=======================================================================
11
12 C --*** ARCYXZ *** (GEN3D) Calculate 3D coordinates - rotation about Y
13 C -- Written by Amy Gilkey - revised 05/09/88
14 C -- Modified by Greg Sjaardema - 02/06/89
15 C -- Added Warp Function
16 C -- Added Gradient to Rotations (not for center blocks)
17 C --
18 C --NEWXYZ calculates the coordinate array for the 3D database.
19 C --
20 C --Parameters:
21 C -- XN, YN - IN - the 2D coordinates, destroyed
22 C -- XN3, YN3, ZN3 - OUT - the 3D coordinates
23 C -- IXNP - IN - the new index for each node
24 C -- NRNP - IN - the number of new nodes generated for each node
25 C -- NPCEN - IN - the node numbers of the center nodes by column and row
26 C -- SINANG, COSANG - SCRATCH - size = NNREPL, holds sin and cos of
27 C -- angles for rotations
28 C --
29 C --Common Variables:
30 C -- Uses NDIM, NUMNP of /DBNUMS/
31 C -- Uses NDIM3, NUMNP3 of /DBNUM3/
32 C -- Uses DOTRAN, NNREPL, DIM3, NRTRAN, D3TRAN, ZGRAD,
33 C -- CENTER, NUMCOL, NUMROW of /PARAMS/
34
35 INCLUDE 'g3_dbnums.blk'
36 INCLUDE 'g3_dbnum3.blk'
37 INCLUDE 'g3_params.blk'
38
39 REAL XN(NUMNP), YN(NUMNP),
40 & XN3(NUMNP3), YN3(NUMNP3), ZN3(NUMNP3)
41 INTEGER IXNP(*), NRNP(*)
42 C .. Dimension of NPCEN is (NUMCOL,NUMROW), but NUMCOL may be 0
43 INTEGER NPCEN(NUMCDM,*)
44 REAL SINANG(NNREPL), COSANG(NNREPL)
45
46 PI = ATAN2(0.0, -1.0)
47 C --For rotations, change X and add Z so that they define pie-shaped
48 C --regions around the Y axis
49
50 C --Copy Y coordinate from original
51
52 DO 520 INP = 1, NUMNP
53 JNP0 = IXNP(INP) - 1
54 DO 510 NR = 1, NRNP(INP)
55 YN3(JNP0+NR) = YN(INP)
56 510 CONTINUE
57 520 CONTINUE
58
59 C ... Check minimum X coordinate to see if we will generate bad elements
60 XMIN = XN(1)
61 DO 5 INP = 2, NUMNP
62 XMIN = MIN(XMIN, XN(INP))
63 5 CONTINUE
64 XMIN = XMIN - CENTER
65 if (XMIN .LT. 0) THEN
66 call prterr('WARNING',
67 & 'Input mesh crosses over axis of rotation (Y). Negative '//
68 & 'elements may be generated. Adjust ROTCEN or input mesh.')
69 end if
70
71 C --If center block exists, calculate center of rotation
72 IF (NUMCOL .GT. 0) THEN
73 CENTER = 1E36
74 DO 10 IROW = 1, NUMROW
75 INP = NPCEN(1,IROW)
76 IF (INP .LE. 0) GOTO 10
77 CENTER = MIN (CENTER, XN(INP))
78 10 CONTINUE
79 END IF
80
81 C --Subtract center, so rotation is around zero
82
83 IF (CENTER .NE. 0.0) THEN
84 DO 20 INP = 1, NUMNP
85 XN(INP) = XN(INP) - CENTER
86 20 CONTINUE
87 END IF
88
89 C --Get the coordinates for the non-center nodes
90
91 IBLK = 0
92 NXTNR = 1
93 ZEND = 0.0
94
95 1 CONTINUE
96 IBLK = IBLK + 1
97 IF (NRTRAN(IBLK) .GT. 0) THEN
98 ZBEG = ZEND
99 ZEND = ZBEG + D3TRAN(IBLK) * PI / 180.0
100
101 CALL INIGRD (-ZBEG, -ZEND, ZGRAD(IBLK),
102 * NRTRAN(IBLK), MIN(NRTRAN(IBLK)+1,NNREPL-NXTNR+1),
103 * COSANG(NXTNR))
104 NXTNR = NXTNR + NRTRAN(IBLK)
105 IF (IBLK .LT. MAXINT) GO TO 1
106 END IF
107
108 DO 30 NR = 1, NNREPL
109 ANG = COSANG(NR)
110 SINANG(NR) = SIN (ANG)
111 COSANG(NR) = COS (ANG)
112 30 CONTINUE
113
114 DO 60 INP = 1, NUMNP
115 IF (NRNP(INP) .EQ. NNREPL) THEN
116 JNP = IXNP(INP)
117 X = XN(INP)
118 DO 50 NR = 1, NNREPL
119 XN3(JNP) = X * COSANG(NR)
120 ZN3(JNP) = X * SINANG(NR)
121 JNP = JNP + 1
122 50 CONTINUE
123 END IF
124 60 CONTINUE
125
126 IF (NUMCOL .GT. 0) THEN
127
128 C --For center rotations, process by column for each row;
129 C --calculate the first 8th of the circle, then copy to other 8ths.
130
131 RAD45 = 45.0 * (PI / 180.0)
132 COSD45 = COS (RAD45)
133
134 DO 70 IROW = 1, NUMROW
135 INP = NPCEN(1,IROW)
136 IF (INP .LE. 0) GOTO 70
137 JNP = IXNP(INP)
138 XN3(JNP) = 0.0
139 ZN3(JNP) = 0.0
140 70 CONTINUE
141
142 DO 170 ICOL = 2, NUMCOL
143
144 DO 160 IROW = 1, NUMROW
145 INP = NPCEN(ICOL,IROW)
146 IF (INP .LE. 0) GOTO 160
147
148 JNP = IXNP(INP)
149 JNP0 = JNP - 1
150 NEND = JNP0 + NRNP(INP)
151 XN3(JNP) = XN(INP)
152 ZN3(JNP) = 0.0
153
154 X = XN(INP)
155 XMID = X * COSD45
156
157 DO 80 IX = 2, ICOL-1
158 I = NPCEN(IX,IROW)
159 IF (I .NE. 0) THEN
160 Z = XN(ABS(I))
161 ELSE
162 Z = XN(INP) * (IX-1) / (ICOL-1)
163 END IF
164 IF (X .NE. 0.0) THEN
165 R = Z / X
166 ELSE
167 R = 0.0
168 END IF
169 JNP = JNP + 1
170 XN3(JNP) = SQRT (X*X - Z*Z/2)
171 ZN3(JNP) = - (R * XMID)
172 80 CONTINUE
173
174 JNP = JNP + 1
175 XN3(JNP) = XMID
176 ZN3(JNP) = - XMID
177
178 DO 90 IX = ICOL-1, 1, -1
179 JNP = JNP + 1
180 XN3(JNP) = - ZN3(JNP0+IX)
181 ZN3(JNP) = - XN3(JNP0+IX)
182 90 CONTINUE
183 IF (JNP .LT. NEND) THEN
184 DO 100 IX = 2, ICOL
185 JNP = JNP + 1
186 XN3(JNP) = ZN3(JNP0+IX)
187 ZN3(JNP) = - XN3(JNP0+IX)
188 100 CONTINUE
189 DO 110 IX = ICOL-1, 1, -1
190 JNP = JNP + 1
191 XN3(JNP) = - XN3(JNP0+IX)
192 ZN3(JNP) = ZN3(JNP0+IX)
193 110 CONTINUE
194 END IF
195 IF (JNP .LT. NEND) THEN
196 DO 120 IX = 2, ICOL
197 JNP = JNP + 1
198 XN3(JNP) = - XN3(JNP0+IX)
199 ZN3(JNP) = - ZN3(JNP0+IX)
200 120 CONTINUE
201 DO 130 IX = ICOL-1, 1, -1
202 JNP = JNP + 1
203 XN3(JNP) = ZN3(JNP0+IX)
204 ZN3(JNP) = XN3(JNP0+IX)
205 130 CONTINUE
206 END IF
207 IF (JNP .LT. NEND) THEN
208 DO 140 IX = 2, ICOL
209 JNP = JNP + 1
210 XN3(JNP) = - ZN3(JNP0+IX)
211 ZN3(JNP) = XN3(JNP0+IX)
212 140 CONTINUE
213 DO 150 IX = ICOL-1, 2, -1
214 JNP = JNP + 1
215 XN3(JNP) = XN3(JNP0+IX)
216 ZN3(JNP) = - ZN3(JNP0+IX)
217 150 CONTINUE
218 END IF
219 160 CONTINUE
220 170 CONTINUE
221 END IF
222
223 C --Add center of rotation
224
225 IF (CENTER .NE. 0.0) THEN
226 DO 180 JNP = 1, NUMNP3
227 XN3(JNP) = XN3(JNP) + CENTER
228 180 CONTINUE
229 END IF
230 RETURN
231 END