Debian Codegraph @

packages/seacas/applications/gen3d/g3_arcyxz.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 ARCYXZ (XN, YN, XN3, YN3, ZN3, IXNP, NRNP, NPCEN,
9 & SINANG, COSANG)
10 C=======================================================================
11
12 C --*** ARCYXZ *** (GEN3D) Calculate 3D coordinates - rotation about X
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 X coordinate from original
51
52 DO 520 INP = 1, NUMNP
53 JNP0 = IXNP(INP) - 1
54 DO 510 NR = 1, NRNP(INP)
55 XN3(JNP0+NR) = XN(INP)
56 510 CONTINUE
57 520 CONTINUE
58
59 C ... Check minimum Y coordinate to see if we will generate bad elements
60 YMIN = YN(1)
61 DO 5 INP = 2, NUMNP
62 YMIN = MIN(YMIN, YN(INP))
63 5 CONTINUE
64 YMIN = YMIN - CENTER
65 if (YMIN .LT. 0) THEN
66 call prterr('WARNING',
67 & 'Input mesh crosses over axis of rotation (X). 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
73 IF (NUMCOL .GT. 0) THEN
74 CENTER = 1E36
75 DO 10 IROW = 1, NUMROW
76 INP = NPCEN(1,IROW)
77 IF (INP .LE. 0) GOTO 10
78 CENTER = MIN (CENTER, YN(INP))
79 10 CONTINUE
80 END IF
81
82 C --Subtract center, so rotation is around zero
83
84 IF (CENTER .NE. 0.0) THEN
85 DO 20 INP = 1, NUMNP
86 YN(INP) = YN(INP) - CENTER
87 20 CONTINUE
88 END IF
89
90 C --Get the coordinates for the non-center nodes
91
92 IBLK = 0
93 NXTNR = 1
94 ZEND = 0.0
95
96 1 CONTINUE
97 IBLK = IBLK + 1
98 IF (NRTRAN(IBLK) .GT. 0) THEN
99 ZBEG = ZEND
100 ZEND = ZBEG + D3TRAN(IBLK) * PI / 180.0
101
102 CALL INIGRD (-ZBEG, -ZEND, ZGRAD(IBLK),
103 * NRTRAN(IBLK), MIN(NRTRAN(IBLK)+1,NNREPL-NXTNR+1),
104 * COSANG(NXTNR))
105 NXTNR = NXTNR + NRTRAN(IBLK)
106 IF (IBLK .LT. MAXINT) GO TO 1
107 END IF
108
109 DO 30 NR = 1, NNREPL
110 ANG = COSANG(NR)
111 SINANG(NR) = SIN (ANG)
112 COSANG(NR) = COS (ANG)
113 30 CONTINUE
114
115 DO 60 INP = 1, NUMNP
116 IF (NRNP(INP) .EQ. NNREPL) THEN
117 JNP = IXNP(INP)
118 Y = YN(INP)
119 DO 50 NR = 1, NNREPL
120 YN3(JNP) = Y * COSANG(NR)
121 ZN3(JNP) = Y * SINANG(NR)
122 JNP = JNP + 1
123 50 CONTINUE
124 END IF
125 60 CONTINUE
126
127 IF (NUMCOL .GT. 0) THEN
128
129 C --For center rotations, process by column for each row;
130 C --calculate the first 8th of the circle, then copy to other 8ths.
131
132 RAD45 = 45.0 * (PI / 180.0)
133 COSD45 = COS (RAD45)
134
135 DO 70 IROW = 1, NUMROW
136 INP = NPCEN(1,IROW)
137 IF (INP .LE. 0) GOTO 70
138 JNP = IXNP(INP)
139 YN3(JNP) = 0.0
140 ZN3(JNP) = 0.0
141 70 CONTINUE
142
143 DO 170 ICOL = 2, NUMCOL
144
145 DO 160 IROW = 1, NUMROW
146 INP = NPCEN(ICOL,IROW)
147 IF (INP .LE. 0) GOTO 160
148
149 JNP = IXNP(INP)
150 JNP0 = JNP - 1
151 NEND = JNP0 + NRNP(INP)
152 YN3(JNP) = YN(INP)
153 ZN3(JNP) = 0.0
154
155 Y = YN(INP)
156 YMID = Y * COSD45
157
158 DO 80 IX = 2, ICOL-1
159 I = NPCEN(IX,IROW)
160 IF (I .NE. 0) THEN
161 Z = YN(ABS(I))
162 ELSE
163 Z = YN(INP) * (IX-1) / (ICOL-1)
164 END IF
165 IF (Y .NE. 0.0) THEN
166 R = Z / Y
167 ELSE
168 R = 0.0
169 END IF
170 JNP = JNP + 1
171 YN3(JNP) = SQRT (Y*Y - Z*Z/2)
172 ZN3(JNP) = - (R * YMID)
173 80 CONTINUE
174
175 JNP = JNP + 1
176 YN3(JNP) = YMID
177 ZN3(JNP) = - YMID
178
179 DO 90 IX = ICOL-1, 1, -1
180 JNP = JNP + 1
181 YN3(JNP) = - ZN3(JNP0+IX)
182 ZN3(JNP) = - YN3(JNP0+IX)
183 90 CONTINUE
184 IF (JNP .LT. NEND) THEN
185 DO 100 IX = 2, ICOL
186 JNP = JNP + 1
187 YN3(JNP) = ZN3(JNP0+IX)
188 ZN3(JNP) = - YN3(JNP0+IX)
189 100 CONTINUE
190 DO 110 IX = ICOL-1, 1, -1
191 JNP = JNP + 1
192 YN3(JNP) = - YN3(JNP0+IX)
193 ZN3(JNP) = ZN3(JNP0+IX)
194 110 CONTINUE
195 END IF
196 IF (JNP .LT. NEND) THEN
197 DO 120 IX = 2, ICOL
198 JNP = JNP + 1
199 YN3(JNP) = - YN3(JNP0+IX)
200 ZN3(JNP) = - ZN3(JNP0+IX)
201 120 CONTINUE
202 DO 130 IX = ICOL-1, 1, -1
203 JNP = JNP + 1
204 YN3(JNP) = ZN3(JNP0+IX)
205 ZN3(JNP) = YN3(JNP0+IX)
206 130 CONTINUE
207 END IF
208 IF (JNP .LT. NEND) THEN
209 DO 140 IX = 2, ICOL
210 JNP = JNP + 1
211 YN3(JNP) = - ZN3(JNP0+IX)
212 ZN3(JNP) = YN3(JNP0+IX)
213 140 CONTINUE
214 DO 150 IX = ICOL-1, 2, -1
215 JNP = JNP + 1
216 YN3(JNP) = YN3(JNP0+IX)
217 ZN3(JNP) = - ZN3(JNP0+IX)
218 150 CONTINUE
219 END IF
220 160 CONTINUE
221 170 CONTINUE
222 END IF
223
224 C --Add center of rotation
225
226 IF (CENTER .NE. 0.0) THEN
227 DO 180 JNP = 1, NUMNP3
228 YN3(JNP) = YN3(JNP) + CENTER
229 180 CONTINUE
230 END IF
231 RETURN
232 END