Debian Codegraph @

packages/seacas/applications/gen3d/g3_twixyz.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 TWIXYZ (XN, YN, XN3, YN3, ZN3, IXNP, NRNP, ZCORD,
9 * SINANG, COSANG)
10 C=======================================================================
11
12 C --*** TWIXYZ *** (GEN3D) Calculate 3D coordinates for TWISTS
13 C -- Modified by Greg Sjaardema - 02/06/89
14 C --
15 C --TWIXYZ calculates the coordinate array for the 3D database.
16 C --
17 C --Parameters:
18 C -- XN, YN - IN - the 2D coordinates, destroyed
19 C -- XN3, YN3, ZN3 - OUT - the 3D coordinates
20 C -- IXNP - IN - the new index for each node
21 C -- NRNP - IN - the number of new nodes generated for each node
22 C -- ZCORD - SCRATCH - size = NNREPL, holds z coordinate for transformations
23 C -- SINANG, COSANG - SCRATCH - size = NNREPL, holds sin and cos of
24 C -- angles for rotations
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 C -- Uses XOFFS, YOFFS, ZOFFS of /XYZOFF/
32 C -- Uses ROT3D, ROTMAT of /XYZROT/
33
34 INCLUDE 'g3_dbnums.blk'
35 INCLUDE 'g3_dbnum3.blk'
36 INCLUDE 'g3_params.blk'
37 INCLUDE 'g3_twist.blk'
38
39 REAL XN(NUMNP), YN(NUMNP),
40 & XN3(NUMNP3), YN3(NUMNP3), ZN3(NUMNP3)
41 INTEGER IXNP(*), NRNP(*)
42 REAL ZCORD(NNREPL)
43 REAL SINANG(NNREPL), COSANG(NNREPL)
44
45 PI = ATAN2(0.0, -1.0)
46 D2R = PI / 180.0
47
48 C --For translations, repeat the X coordinate and add a Z coordinate
49
50 IF (ITWTYP .EQ. 1) THEN
51
52 C --Calculate the equal or gradient step for current translation
53
54 IBLK = 0
55 NXTNR = 1
56
57 ZEND = 0.0
58 10 CONTINUE
59 IBLK = IBLK + 1
60 IF (NRTRAN(IBLK) .GT. 0) THEN
61 ZBEG = ZEND
62 ZEND = ZBEG + D3TRAN(IBLK)
63 CALL INIGRD (-ZBEG, -ZEND, ZGRAD(IBLK),
64 * NRTRAN(IBLK), NRTRAN(IBLK)+1, ZCORD(NXTNR) )
65 NXTNR = NXTNR + NRTRAN(IBLK)
66 IF (IBLK .LT. MAXINT) GO TO 10
67 END IF
68
69 D3 = - (TWANGL / NEREPL) * D2R
70 DO 20 NR = 1, NNREPL
71 ANG = D3 * (NR-1)
72 SINANG(NR) = SIN (ANG)
73 COSANG(NR) = COS (ANG)
74 20 CONTINUE
75
76 C --Repeat the X coordinate and add the calculated Z coordinate
77
78 DO 40 INP = 1, NUMNP
79 JNP = IXNP(INP) - 1
80 DO 30 NR = 1, NNREPL
81 XT = COSANG(NR) * (XN(INP) - TWXCEN) -
82 * SINANG(NR) * (YN(INP) - TWYCEN) + TWXCEN
83 YT = SINANG(NR) * (XN(INP) - TWXCEN) +
84 * COSANG(NR) * (YN(INP) - TWYCEN) + TWYCEN
85 XN3(JNP+NR) = XT
86 YN3(JNP+NR) = YT
87 ZN3(JNP+NR) = ZCORD(NR)
88 30 CONTINUE
89 40 CONTINUE
90 ELSE IF (ITWTYP .EQ. 2) THEN
91
92 C --Get the coordinates for the non-center nodes (evenly spaced)
93
94 IBLK = 0
95 NXTNR = 1
96
97 ZEND = 0.0
98 50 CONTINUE
99 IBLK = IBLK + 1
100 IF (NRTRAN(IBLK) .GT. 0) THEN
101 ZBEG = ZEND
102 ZEND = ZBEG + D3TRAN(IBLK) * D2R
103 CALL INIGRD (-ZBEG, -ZEND, ZGRAD(IBLK),
104 * NRTRAN(IBLK), NRTRAN(IBLK)+1, COSANG(NXTNR) )
105 NXTNR = NXTNR + NRTRAN(IBLK)
106 IF (IBLK .LT. MAXINT) GO TO 50
107 END IF
108
109 DO 60 NR = 1, NNREPL
110 ANG = COSANG(NR)
111 SINANG(NR) = SIN (ANG)
112 COSANG(NR) = COS (ANG)
113 60 CONTINUE
114
115 D3 = - (TWANGL / NEREPL) * D2R
116 DO 80 INP = 1, NUMNP
117 IF (NRNP(INP) .EQ. NNREPL) THEN
118 JNP = IXNP(INP)
119 DO 70 NR = 1, NNREPL
120 TWANG = D3 * (NR-1)
121 SINTW = SIN(TWANG)
122 COSTW = COS(TWANG)
123 XT = COSTW * (XN(INP) - TWXCEN) -
124 * SINTW * (YN(INP) - TWYCEN) + TWXCEN
125 YT = SINTW * (XN(INP) - TWXCEN) +
126 * COSTW * (YN(INP) - TWYCEN) + TWYCEN
127 XN3(JNP) = (XT - CENTER) * COSANG(NR)
128 YN3(JNP) = YT
129 ZN3(JNP) = (XT - CENTER) * SINANG(NR)
130 JNP = JNP + 1
131 70 CONTINUE
132 END IF
133 80 CONTINUE
134
135 C --Add center of rotation
136
137 IF (CENTER .NE. 0.0) THEN
138 DO 90 JNP = 1, NUMNP3
139 XN3(JNP) = XN3(JNP) + CENTER
140 90 CONTINUE
141 END IF
142 END IF
143 RETURN
144 END