Debian Codegraph @

packages/seacas/applications/gen3d/g3_proxyz.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 PROXYZ (XN, YN, XN3, YN3, ZN3, IXNP, NRNP, ZCORD,
9 * SINANG, COSANG)
10 C=======================================================================
11
12 C --*** PROXYZ *** (GEN3D) Calculate 3D coordinates for experimental
13 C -- Modified by Greg Sjaardema - 02/06/89
14 C --
15 C --Parameters:
16 C -- XN, YN - IN - the 2D coordinates, destroyed
17 C -- XN3, YN3, ZN3 - OUT - the 3D coordinates
18 C -- IXNP - IN - the new index for each node
19 C -- NRNP - IN - the number of new nodes generated for each node
20 C -- ZCORD - SCRATCH - size = NNREPL, holds z coordinate for transformations
21 C -- SINANG, COSANG - SCRATCH - size = NNREPL, holds sin and cos of
22 C -- angles for rotations
23 C --
24 C --Common Variables:
25 C -- Uses NDIM, NUMNP of /DBNUMS/
26 C -- Uses NDIM3, NUMNP3 of /DBNUM3/
27 C -- Uses DOTRAN, NNREPL, DIM3, NRTRAN, D3TRAN, XXGRAD,
28 C -- CENTER, NUMCOL, NUMROW of /PARAMS/
29 C -- Uses XOFFS, YOFFS, ZOFFS of /XYZOFF/
30 C -- Uses ROT3D, ROTMAT of /XYZROT/
31
32 INCLUDE 'g3_dbnums.blk'
33 INCLUDE 'g3_dbnum3.blk'
34 INCLUDE 'g3_params.blk'
35 INCLUDE 'g3_xxxxx.blk'
36
37 REAL XN(NUMNP), YN(NUMNP),
38 & XN3(NUMNP3), YN3(NUMNP3), ZN3(NUMNP3)
39 INTEGER IXNP(*), NRNP(*)
40 REAL ZCORD(NNREPL)
41 REAL SINANG(NNREPL), COSANG(NNREPL)
42
43 C --Initialize the parametric interval distance
44
45 ZTOT = 0.0
46 DO 10 IBLK = 1, NBLK
47 IF (NRTRAN(IBLK) .GT. 0) THEN
48 ZTOT = ZTOT + D3TRAN(IBLK)
49 ELSE
50 CALL PRTERR ('PROGRAM',
51 * 'Zero translations found')
52 NBLK = IBLK
53 GO TO 20
54 END IF
55 10 CONTINUE
56
57 IF (ZTOT .EQ. 0.0) THEN
58 CALL PRTERR ('CMDERR', 'Total translation distance is zero')
59 STOP
60 END IF
61
62 NXTNR = 1
63 ZEND = 0.0
64 20 CONTINUE
65 DO 30 IBLK = 1, NBLK
66 ZBEG = ZEND
67 ZEND = ZBEG + D3TRAN(IBLK)
68 CALL INIGRD (ZBEG/ZTOT, ZEND/ZTOT, ZGRAD(IBLK),
69 * NRTRAN(IBLK), NRTRAN(IBLK)+1, ZCORD(NXTNR) )
70 NXTNR = NXTNR + NRTRAN(IBLK)
71 30 CONTINUE
72
73 C --Project bottom surface onto a plane
74
75 IF (ISXWRP .EQ. ISFLAT) THEN
76 DO 50 INP = 1, NUMNP
77 XB = XN(INP)
78 YB = YN(INP)
79 ZB = 0.0
80 XT = (XN(INP) - XXSCL0) * XXSCAL + XXSCL0
81 YT = (YN(INP) - XYSCL0) * XYSCAL + XYSCL0
82 ZT = - ZTOT + (XXA * XT + XXB * YT) / XXC
83 XT = XT + XXOFFS
84 YT = YT + XYOFFS
85
86 JNP = IXNP(INP) - 1
87 DO 40 NR = 1, NNREPL
88 XN3(JNP+NR) = XB + (XT - XB) * ZCORD(NR)
89 YN3(JNP+NR) = YB + (YT - YB) * ZCORD(NR)
90 ZN3(JNP+NR) = ZB + (ZT - ZB) * ZCORD(NR)
91 40 CONTINUE
92 50 CONTINUE
93
94 C ... Warp of translated surface
95
96 ELSE IF (ISXWRP .EQ. ISSPHE) THEN
97 IF (CONVEX) THEN
98 ZCEN = ZTOT - XWARP
99 RMULT = 1.0
100 ELSE
101 ZCEN = ZTOT + XWARP
102 RMULT = -1.0
103 END IF
104 DO 70 INP = 1, NUMNP
105 XB = XN(INP)
106 YB = YN(INP)
107 ZB = 0.0
108 XT = (XN(INP) - XXSCL0) * XXSCAL + XXSCL0
109 YT = (YN(INP) - XYSCL0) * XYSCAL + XYSCL0
110
111 C ... Note: ZT must be negative
112
113 ZT = - (ZCEN + RMULT * SQRT(XWARP**2 - XB**2 - YB**2))
114 XT = XT + XXOFFS
115 YT = YT + XYOFFS
116
117 JNP = IXNP(INP) - 1
118 DO 60 NR = 1, NNREPL
119 XN3(JNP+NR) = XB + (XT - XB) * ZCORD(NR)
120 YN3(JNP+NR) = YB + (YT - YB) * ZCORD(NR)
121 ZN3(JNP+NR) = ZB + (ZT - ZB) * ZCORD(NR)
122 60 CONTINUE
123 70 CONTINUE
124
125 C ... Toroidal Surface
126 ELSE IF (ISXWRP .EQ. ISTORO) THEN
127 IF (CONVEX) THEN
128 ZCEN = ZTOT - XWARP - YWARP
129 RMULT = 1.0
130 ELSE
131 ZCEN = ZTOT + XWARP + YWARP
132 RMULT = -1.0
133 END IF
134 DO 90 INP = 1, NUMNP
135 XB = XN(INP)
136 YB = YN(INP)
137 ZB = 0.0
138 XT = (XN(INP) - XXSCL0) * XXSCAL + XXSCL0
139 YT = (YN(INP) - XYSCL0) * XYSCAL + XYSCL0
140
141 C ... Note: ZT must be negative
142
143 ZA = ZCEN + RMULT * SQRT(XWARP**2 - YB**2)
144 ZT = - (ZA + RMULT * SQRT(YWARP**2 - XB**2))
145 XT = XT + XXOFFS
146 YT = YT + XYOFFS
147
148 JNP = IXNP(INP) - 1
149 DO 80 NR = 1, NNREPL
150 XN3(JNP+NR) = XB + (XT - XB) * ZCORD(NR)
151 YN3(JNP+NR) = YB + (YT - YB) * ZCORD(NR)
152 ZN3(JNP+NR) = ZB + (ZT - ZB) * ZCORD(NR)
153 80 CONTINUE
154 90 CONTINUE
155
156 C ... Cylinder with Axis on X Axis
157 ELSE IF (ISXWRP .EQ. ISXCYL) THEN
158 IF (CONVEX) THEN
159 ZCEN = ZTOT - XWARP
160 RMULT = 1.0
161 ELSE
162 ZCEN = ZTOT + XWARP
163 RMULT = -1.0
164 END IF
165 DO 110 INP = 1, NUMNP
166 XB = XN(INP)
167 YB = YN(INP)
168 ZB = 0.0
169 XT = (XN(INP) - XXSCL0) * XXSCAL + XXSCL0
170 YT = (YN(INP) - XYSCL0) * XYSCAL + XYSCL0
171
172 C ... Note: ZT must be negative
173
174 ZT = - (ZCEN + RMULT * SQRT(XWARP**2 - YB**2))
175 XT = XT + XXOFFS
176 YT = YT + XYOFFS
177
178 JNP = IXNP(INP) - 1
179 DO 100 NR = 1, NNREPL
180 XN3(JNP+NR) = XB + (XT - XB) * ZCORD(NR)
181 YN3(JNP+NR) = YB + (YT - YB) * ZCORD(NR)
182 ZN3(JNP+NR) = ZB + (ZT - ZB) * ZCORD(NR)
183 100 CONTINUE
184 110 CONTINUE
185
186 C ... Cylinder with Axis on Y Axis
187 ELSE IF (ISXWRP .EQ. ISYCYL) THEN
188 IF (CONVEX) THEN
189 ZCEN = ZTOT - YWARP
190 RMULT = 1.0
191 ELSE
192 ZCEN = ZTOT + YWARP
193 RMULT = -1.0
194 END IF
195 DO 130 INP = 1, NUMNP
196 XB = XN(INP)
197 YB = YN(INP)
198 ZB = 0.0
199 XT = (XN(INP) - XXSCL0) * XXSCAL + XXSCL0
200 YT = (YN(INP) - XYSCL0) * XYSCAL + XYSCL0
201
202 C ... Note: ZT must be negative
203
204 ZT = - (ZCEN + RMULT * SQRT(YWARP**2 - XB**2))
205 XT = XT + XXOFFS
206 YT = YT + XYOFFS
207
208 JNP = IXNP(INP) - 1
209 DO 120 NR = 1, NNREPL
210 XN3(JNP+NR) = XB + (XT - XB) * ZCORD(NR)
211 YN3(JNP+NR) = YB + (YT - YB) * ZCORD(NR)
212 ZN3(JNP+NR) = ZB + (ZT - ZB) * ZCORD(NR)
213 120 CONTINUE
214 130 CONTINUE
215 END IF
216
217 RETURN
218 END