Debian Codegraph @

packages/seacas/applications/gen3d/g3_wrpxyz.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 WRPXYZ (XN, YN, XN3, YN3, ZN3, IXNP, NRNP, ZCORD )
9 C=======================================================================
10
11 C --*** WRPXYZ *** (GEN3D) Calculate 3D coordinates
12 C -- Written by Amy Gilkey - revised 05/09/88
13 C -- Modified by Greg Sjaardema - 02/06/89
14 C -- Added Warp Function
15 C -- Added Gradient to Rotations (not for center blocks)
16 C --
17 C --WRPXYZ calculates the coordinate array for the 3D warp translations.
18 C --
19 C --Parameters:
20 C -- XN, YN - IN - the 2D coordinates, destroyed
21 C -- XN3, YN3, ZN3 - OUT - the 3D coordinates
22 C -- IXNP - IN - the new index for each node
23 C -- NRNP - IN - the number of new nodes generated for each node
24 C -- ZCORD - SCRATCH - size = NNREPL, holds z coordinate for transformations
25 C --
26 C --Common Variables:
27 C -- Uses NDIM, NUMNP of /DBNUMS/
28 C -- Uses NDIM3, NUMNP3 of /DBNUM3/
29 C -- Uses DOTRAN, NNREPL, DIM3, NRTRAN, D3TRAN, ZGRAD,
30 C -- CENTER, NUMCOL, NUMROW of /PARAMS/
31
32 INCLUDE 'g3_dbnums.blk'
33 INCLUDE 'g3_dbnum3.blk'
34 INCLUDE 'g3_params.blk'
35
36 REAL XN(NUMNP), YN(NUMNP),
37 & XN3(NUMNP3), YN3(NUMNP3), ZN3(NUMNP3)
38 INTEGER IXNP(*), NRNP(*)
39 REAL ZCORD(NNREPL)
40
41 C ... Doing a Warp
42 C ... CALCULATE THE THICKNESS INCREMENT FOR EACH TRANSLATION
43
44 IF (VEDGE) THEN
45 CALL INIGRD (0.0, 1.0, ZGRAD(1), NRTRAN(1), NNREPL, ZCORD)
46 ELSE
47 CALL INIGRD (DWARP, DWARP+D3TRAN(1), ZGRAD(1), NRTRAN(1),
48 * NNREPL, ZCORD)
49 END IF
50
51 C NOGRAD = (ABS (ZGRAD(1) - 1.0) .LE. 0.001)
52 C IF (NOGRAD) THEN
53 C D3 = 1.0 / NRTRAN(1)
54 C ELSE
55 C D3 = (1.0 - ZGRAD(1)) / (1.0 - ZGRAD(1)**NRTRAN(1))
56 C END IF
57
58 C IF (.NOT. VEDGE) THEN
59 C D3 = D3 * D3TRAN(1)
60 C END IF
61
62 C IF (NOGRAD) THEN
63 C IF (VEDGE) THEN
64 C DO 10 NR = 1, NNREPL
65 C ZCORD(NR) = D3 * (NR-1)
66 C 10 CONTINUE
67 C ELSE
68 C DO 20 NR = 1, NNREPL
69 C ZCORD(NR) = DWARP + D3 * (NR-1)
70 C 20 CONTINUE
71 C END IF
72 C ELSE
73 C IF (VEDGE) THEN
74 C ZCORD(1) = 0.0
75 C ELSE
76 C ZCORD(1) = DWARP
77 C END IF
78 C DO 30 NR = 2, NNREPL
79 C ZCORD(NR) = ZCORD(NR-1) + D3 * ZGRAD(1)**(NR-2)
80 C 30 CONTINUE
81 C END IF
82
83 IF (IWARP .EQ. 1) THEN
84
85 C ... Warp type 1: Point Centered
86
87 DO 60 INP = 1, NUMNP
88 JNP0 = IXNP(INP) - 1
89 DX = XN(INP)
90 DY = YN(INP)
91 ZT = DWARP - SQRT(DWARP**2 - DX**2 - DY**2)
92 IF (VEDGE) THEN
93 DWARPB = DWARP + D3TRAN(1)
94 ZB = DWARP - SQRT(DWARPB**2 - DX**2 - DY**2)
95 DO 40 NR = 1, NRNP(INP)
96 ZN3(JNP0+NR) = ZT + (ZB - ZT) * ZCORD(NR)
97 YN3(JNP0+NR) = YN(INP)
98 XN3(JNP0+NR) = XN(INP)
99 40 CONTINUE
100 ELSE
101 C1 = SQRT (XN(INP)**2 + YN(INP)**2 + (ZT-DWARP)**2)
102 DO 50 NR = 1, NRNP(INP)
103 TNR = ZCORD(NR) / C1
104 ZN3(JNP0+NR) = DWARP + (ZT - DWARP) * TNR
105 YN3(JNP0+NR) = YN(INP) * TNR
106 XN3(JNP0+NR) = XN(INP) * TNR
107 50 CONTINUE
108 END IF
109 60 CONTINUE
110
111 CONTINUE
112 ELSE IF (IWARP .EQ. -1) THEN
113
114 C ... Warp type -1: X Axis Centered
115
116 DO 90 INP = 1, NUMNP
117 JNP0 = IXNP(INP) - 1
118 THET = YN(INP) / DWARP
119 C1 = SIN(THET)
120 C2 = COS(THET)
121 IF (VEDGE) THEN
122 XT = XN(INP)
123 YT = C1 * DWARP
124 ZT = DWARP - C2 * DWARP
125
126 DWARPB = DWARP + D3TRAN(1)
127 ZB = DWARP - SQRT(ABS(DWARPB**2 - YT**2))
128 XB = XT
129 YB = YT
130
131 DO 70 NR = 1, NRNP(INP)
132 XN3(JNP0+NR) = XT + (XB - XT) * ZCORD(NR)
133 YN3(JNP0+NR) = YT + (YB - YT) * ZCORD(NR)
134 ZN3(JNP0+NR) = ZT + (ZB - ZT) * ZCORD(NR)
135 70 CONTINUE
136 ELSE
137 DO 80 NR = 1, NRNP(INP)
138 XN3(JNP0+NR) = XN(INP)
139 YN3(JNP0+NR) = C1 * ZCORD(NR)
140 ZN3(JNP0+NR) = DWARP - C2 * ZCORD(NR)
141 80 CONTINUE
142 END IF
143 90 CONTINUE
144
145 ELSE IF (IWARP .EQ. -2) THEN
146
147 C ... Warp type -2: Y Axis Centered
148
149 DO 120 INP = 1, NUMNP
150 JNP0 = IXNP(INP) - 1
151 THET = XN(INP) / DWARP
152 C1 = SIN(THET)
153 C2 = COS(THET)
154 IF (VEDGE) THEN
155 XT = C1 * DWARP
156 YT = YN(INP)
157 ZT = DWARP - C2 * DWARP
158
159 DWARPB = DWARP + D3TRAN(1)
160 ZB = DWARP - SQRT(ABS(DWARPB**2 - XT**2))
161 XB = XT
162 YB = YT
163
164 DO 100 NR = 1, NRNP(INP)
165 XN3(JNP0+NR) = XT + (XB - XT) * ZCORD(NR)
166 YN3(JNP0+NR) = YT + (YB - YT) * ZCORD(NR)
167 ZN3(JNP0+NR) = ZT + (ZB - ZT) * ZCORD(NR)
168 100 CONTINUE
169 ELSE
170 DO 110 NR = 1, NRNP(INP)
171 XN3(JNP0+NR) = C1 * ZCORD(NR)
172 YN3(JNP0+NR) = YN(INP)
173 ZN3(JNP0+NR) = DWARP - C2 * ZCORD(NR)
174 110 CONTINUE
175 END IF
176 120 CONTINUE
177
178 ELSE IF (IWARP .EQ. 2) THEN
179
180 C ... Warp type 1: Point-Centered Ellipse
181
182 DO 360 INP = 1, NUMNP
183 JNP0 = IXNP(INP) - 1
184 DX = XN(INP)
185 DY = YN(INP)
186 ZT = DWARP - DWARP / HRAD * SQRT(HRAD**2 - DX**2 - DY**2)
187 IF (VEDGE) THEN
188 DWARPB = DWARP + D3TRAN(1)
189 ZB = DWARP - DWARPB/HRAD * SQRT(HRAD**2 - DX**2 - DY**2)
190 DO 340 NR = 1, NRNP(INP)
191 ZN3(JNP0+NR) = ZT + (ZB - ZT) * ZCORD(NR)
192 YN3(JNP0+NR) = YN(INP)
193 XN3(JNP0+NR) = XN(INP)
194 340 CONTINUE
195 ELSE
196 C1 = SQRT (XN(INP)**2 + YN(INP)**2 + (ZT-DWARP)**2)
197 DO 350 NR = 1, NRNP(INP)
198 TNR = ZCORD(NR) / C1
199 ZN3(JNP0+NR) = DWARP + (ZT - DWARP) * TNR
200 YN3(JNP0+NR) = YN(INP) * TNR
201 XN3(JNP0+NR) = XN(INP) * TNR
202 350 CONTINUE
203 END IF
204 360 CONTINUE
205
206 CONTINUE
207 END IF
208 RETURN
209 END