Debian Codegraph @

packages/seacas/applications/numbers/nu_cgcal3.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 SUBROUTINE CGCAL3(CRD,IX,MAT,MASS,VOL,DENS,VOLM,CG,ZITOT,XXX,
8 * XG,XI,XINI,AJ,NNODES,NDIM,NQUAD,VOLMN,IELM,NELBLK,NUMNP)
9
10 C ... CALCULATE PROPERTIES FOR THREE-DIMENSIONAL MESH --- BRICKS ONLY
11
12 DIMENSION CRD(NUMNP,*), IX(NNODES,*), MAT(6,*), MASS(*),
13 * DENS(*), VOLM(*), CG(*), ZITOT(*),VOLMN(4,*),IELM(4,*),
14 * XXX(3+1,NQUAD,*),XG(3,*), XI(3,*), XINI(*),
15 * AJ(3,*)
16 DIMENSION ZI(6), ZMOM(3)
17 DIMENSION CCC(3,8)
18
19 REAL MASS, MASSE
20
21 C ... VOLMN(1,*) = MINIMUM VOLUME (AREAS FOR 2-D)
22 C VOLMN(2,*) = MAXIMUM VOLUME
23 C VOLMN(3,*) = TOTAL VOLUME
24 C VOLMN(4,*) = MAXIMUM SUM OF SQUARES OF INVERSE LENGTHS
25
26 DO 10 I=1, NELBLK
27 VOLMN(1,I) = 1.0E30
28 VOLMN(2,I) = 0.0
29 VOLMN(3,I) = 0.0
30 IELM (3,I) = 0
31 MASS(I) = 0.0
32 VOLM(I) = 0.0
33 10 CONTINUE
34 DO 20 I=1,3
35 ZITOT(I) = 0.0
36 ZITOT(I+3) = 0.0
37 ZMOM(I) = 0.0
38 20 CONTINUE
39 ZMAS = 0.0
40 VOL = 0.0
41
42 C ... GET QUADRATURE POINT LOCATIONS, EVALUATE SHAPE FUNCTIONS
43
44 CALL QUAD(XXX, XI, XG, NDIM, NNODES, NQUAD, WT)
45
46 DO 80 IBLK = 1, NELBLK
47 IF (MAT(5,IBLK) .NE. 1) GOTO 80
48 IELBEG = MAT(3,IBLK)
49 IELEND = MAT(4,IBLK)
50 MIEL = IBLK
51 DO 70 IEL = IELBEG, IELEND
52
53 C ... CALCULATE ARA, VOLUME, AND MOMENTS OF INERTIA OF ELEMENT
54
55 DO 30 I=1,3
56 ZI(I) = 0.0
57 ZI(I+3) = 0.0
58 CG(I) = 0.0
59 30 CONTINUE
60 VOLUME = 0.0
61
62 DO 40 I=1,8
63 CCC(1,I) = CRD(IX(I,IEL),1)
64 CCC(2,I) = CRD(IX(I,IEL),2)
65 CCC(3,I) = CRD(IX(I,IEL),3)
66 40 CONTINUE
67
68 DO 60 NG=1,NQUAD
69 DET = 0.0
70
71 XINI(1) = XXX(1,1,NG) * CCC(1,1) +
72 * XXX(1,2,NG) * CCC(1,2) + XXX(1,3,NG) * CCC(1,3) +
73 * XXX(1,4,NG) * CCC(1,4) + XXX(1,5,NG) * CCC(1,5) +
74 * XXX(1,6,NG) * CCC(1,6) + XXX(1,7,NG) * CCC(1,7) +
75 * XXX(1,8,NG) * CCC(1,8)
76 XINI(2) = XXX(1,1,NG) * CCC(2,1) +
77 * XXX(1,2,NG) * CCC(2,2) + XXX(1,3,NG) * CCC(2,3) +
78 * XXX(1,4,NG) * CCC(2,4) + XXX(1,5,NG) * CCC(2,5) +
79 * XXX(1,6,NG) * CCC(2,6) + XXX(1,7,NG) * CCC(2,7) +
80 * XXX(1,8,NG) * CCC(2,8)
81 XINI(3) = XXX(1,1,NG) * CCC(3,1) +
82 * XXX(1,2,NG) * CCC(3,2) + XXX(1,3,NG) * CCC(3,3) +
83 * XXX(1,4,NG) * CCC(3,4) + XXX(1,5,NG) * CCC(3,5) +
84 * XXX(1,6,NG) * CCC(3,6) + XXX(1,7,NG) * CCC(3,7) +
85 * XXX(1,8,NG) * CCC(3,8)
86
87 AJ(1,1) = XXX(2,1,NG) * CCC(1,1)
88 * + XXX(2,2,NG) * CCC(1,2) + XXX(2,3,NG) * CCC(1,3)
89 * + XXX(2,4,NG) * CCC(1,4) + XXX(2,5,NG) * CCC(1,5)
90 * + XXX(2,6,NG) * CCC(1,6) + XXX(2,7,NG) * CCC(1,7)
91 * + XXX(2,8,NG) * CCC(1,8)
92 AJ(2,1) = XXX(3,1,NG) * CCC(1,1)
93 * + XXX(3,2,NG) * CCC(1,2) + XXX(3,3,NG) * CCC(1,3)
94 * + XXX(3,4,NG) * CCC(1,4) + XXX(3,5,NG) * CCC(1,5)
95 * + XXX(3,6,NG) * CCC(1,6) + XXX(3,7,NG) * CCC(1,7)
96 * + XXX(3,8,NG) * CCC(1,8)
97 AJ(3,1) = XXX(4,1,NG) * CCC(1,1)
98 * + XXX(4,2,NG) * CCC(1,2) + XXX(4,3,NG) * CCC(1,3)
99 * + XXX(4,4,NG) * CCC(1,4) + XXX(4,5,NG) * CCC(1,5)
100 * + XXX(4,6,NG) * CCC(1,6) + XXX(4,7,NG) * CCC(1,7)
101 * + XXX(4,8,NG) * CCC(1,8)
102
103 AJ(1,2) = XXX(2,1,NG) * CCC(2,1)
104 * + XXX(2,2,NG) * CCC(2,2) + XXX(2,3,NG) * CCC(2,3)
105 * + XXX(2,4,NG) * CCC(2,4) + XXX(2,5,NG) * CCC(2,5)
106 * + XXX(2,6,NG) * CCC(2,6) + XXX(2,7,NG) * CCC(2,7)
107 * + XXX(2,8,NG) * CCC(2,8)
108 AJ(2,2) = XXX(3,1,NG) * CCC(2,1)
109 * + XXX(3,2,NG) * CCC(2,2) + XXX(3,3,NG) * CCC(2,3)
110 * + XXX(3,4,NG) * CCC(2,4) + XXX(3,5,NG) * CCC(2,5)
111 * + XXX(3,6,NG) * CCC(2,6) + XXX(3,7,NG) * CCC(2,7)
112 * + XXX(3,8,NG) * CCC(2,8)
113 AJ(3,2) = XXX(4,1,NG) * CCC(2,1)
114 * + XXX(4,2,NG) * CCC(2,2) + XXX(4,3,NG) * CCC(2,3)
115 * + XXX(4,4,NG) * CCC(2,4) + XXX(4,5,NG) * CCC(2,5)
116 * + XXX(4,6,NG) * CCC(2,6) + XXX(4,7,NG) * CCC(2,7)
117 * + XXX(4,8,NG) * CCC(2,8)
118
119 AJ(1,3) = XXX(2,1,NG) * CCC(3,1)
120 * + XXX(2,2,NG) * CCC(3,2) + XXX(2,3,NG) * CCC(3,3)
121 * + XXX(2,4,NG) * CCC(3,4) + XXX(2,5,NG) * CCC(3,5)
122 * + XXX(2,6,NG) * CCC(3,6) + XXX(2,7,NG) * CCC(3,7)
123 * + XXX(2,8,NG) * CCC(3,8)
124 AJ(2,3) = XXX(3,1,NG) * CCC(3,1)
125 * + XXX(3,2,NG) * CCC(3,2) + XXX(3,3,NG) * CCC(3,3)
126 * + XXX(3,4,NG) * CCC(3,4) + XXX(3,5,NG) * CCC(3,5)
127 * + XXX(3,6,NG) * CCC(3,6) + XXX(3,7,NG) * CCC(3,7)
128 * + XXX(3,8,NG) * CCC(3,8)
129 AJ(3,3) = XXX(4,1,NG) * CCC(3,1)
130 * + XXX(4,2,NG) * CCC(3,2) + XXX(4,3,NG) * CCC(3,3)
131 * + XXX(4,4,NG) * CCC(3,4) + XXX(4,5,NG) * CCC(3,5)
132 * + XXX(4,6,NG) * CCC(3,6) + XXX(4,7,NG) * CCC(3,7)
133 * + XXX(4,8,NG) * CCC(3,8)
134
135 DET = AJ(1,1) * (AJ(2,2)*AJ(3,3) - AJ(2,3)*AJ(3,2))
136 * -AJ(1,2) * (AJ(2,1)*AJ(3,3) - AJ(2,3)*AJ(3,1))
137 * +AJ(1,3) * (AJ(2,1)*AJ(3,2) - AJ(2,2)*AJ(3,1))
138 DET = DET * WT
139 DETW = DET * DENS(MIEL)
140
141 CG(1) = CG(1) + DETW * XINI(1)
142 CG(2) = CG(2) + DETW * XINI(2)
143 CG(3) = CG(3) + DETW * XINI(3)
144
145 ZI(1) = ZI(1) + DETW * XINI(1)**2
146 ZI(2) = ZI(2) + DETW * XINI(2)**2
147 ZI(3) = ZI(3) + DETW * XINI(3)**2
148
149 ZI(4) = ZI(4) + DETW * XINI(1) * XINI(2)
150 ZI(5) = ZI(5) + DETW * XINI(1) * XINI(3)
151 ZI(6) = ZI(6) + DETW * XINI(2) * XINI(3)
152
153 VOLUME = VOLUME + DET
154
155 60 CONTINUE
156
157 C ... DETERMINE MIN/MAX ELEMENT VOLUMES FOR EACH MATERIAL AND
158 C COUNT NUMBER OF ELEMENTS FOR EACH MATERIAL
159
160 IELM(3,MIEL) = IELM(3,MIEL) + 1
161 VOLMN(3,MIEL) = VOLMN(3,MIEL) + VOLUME
162 IF (VOLUME .LT. VOLMN(1,MIEL)) THEN
163 VOLMN(1,MIEL) = VOLUME
164 IELM(1,MIEL) = IEL
165 END IF
166 C ... Changed from else if to if so 1 element and equal size blocks get correct volume
167 IF (VOLUME .GT. VOLMN(2,MIEL)) THEN
168 VOLMN(2,MIEL) = VOLUME
169 IELM(2,MIEL) = IEL
170 END IF
171
172 if (volume .le. 0.0) then
173 write (*,*) 'Zero or negative volume at element',
174 & iel
175 end if
176 ZITOT(1) = ZITOT(1) + ZI(2) + ZI(3)
177 ZITOT(2) = ZITOT(2) + ZI(1) + ZI(3)
178 ZITOT(3) = ZITOT(3) + ZI(1) + ZI(2)
179 ZITOT(4) = ZITOT(4) + ZI(4)
180 ZITOT(5) = ZITOT(5) + ZI(5)
181 ZITOT(6) = ZITOT(6) + ZI(6)
182 MASSE = VOLUME * DENS(MIEL)
183 MASS(MIEL)= MASS(MIEL) + MASSE
184 VOLM(MIEL)= VOLM(MIEL) + VOLUME
185 VOL = VOL + VOLUME
186 ZMAS = ZMAS + MASSE
187 ZMOM(1) = ZMOM(1) + CG(1)
188 ZMOM(2) = ZMOM(2) + CG(2)
189 ZMOM(3) = ZMOM(3) + CG(3)
190 70 CONTINUE
191 80 CONTINUE
192 FIX = SIGN(0.5, ZMAS) + SIGN(0.5, -ZMAS)
193 DO 90 I=1,3
194 CG(I) = ZMOM(I) / (ZMAS + FIX)
195 90 CONTINUE
196 ZITOT(1) = ZITOT(1) - ZMAS * (CG(2)**2 + CG(3)**2)
197 ZITOT(2) = ZITOT(2) - ZMAS * (CG(1)**2 + CG(3)**2)
198 ZITOT(3) = ZITOT(3) - ZMAS * (CG(1)**2 + CG(2)**2)
199 ZITOT(4) = ZITOT(4) - ZMAS * CG(1) * CG(2)
200 ZITOT(5) = ZITOT(5) - ZMAS * CG(1) * CG(3)
201 ZITOT(6) = ZITOT(6) - ZMAS * CG(2) * CG(3)
202
203 RETURN
204 END