Debian Codegraph @

packages/seacas/applications/numbers/nu_vol3d.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 VOL3D( COORD, LSTSN, NSEG, VOLUME, NDIM, NUMESS,
8 * CENT, NUMNP, CENTER)
9
10 C***********************************************************************
11
12 C DESCRIPTION:
13 C This routine computes the volume of a cavity formed
14 C by the boundary of an element side set flag
15
16 C FORMAL PARAMETERS:
17 C COORD REAL Nodal Coordinates
18 C LSTSN INTEGER List of nodes on this boundary
19 C NSEG INTEGER Number of segments in this boundary
20 C VOLUME REAL Volume of this cavity
21 C NDIM INTEGER Number of Nodes
22 C CENT REAL Apex of Cavity Volume pentahedra
23
24 C CALLED BY:
25
26 C***********************************************************************
27
28 DIMENSION COORD(NUMNP, *), LSTSN(*), CENT(3)
29 LOGICAL CENTER
30
31 VOLUME = 0.0
32
33 IF (.NOT. CENTER) THEN
34 XC = 0.0
35 YC = 0.0
36 ZC = 0.0
37 DO KSEG = 1 , NSEG
38 L = LSTSN(4*KSEG)
39 K = LSTSN(4*KSEG - 1)
40 J = LSTSN(4*KSEG - 2)
41 I = LSTSN(4*KSEG - 3)
42
43 X1 = COORD(I,1)
44 X2 = COORD(J,1)
45 X3 = COORD(K,1)
46 X4 = COORD(L,1)
47
48 Y1 = COORD(I,2)
49 Y2 = COORD(J,2)
50 Y3 = COORD(K,2)
51 Y4 = COORD(L,2)
52
53 Z1 = COORD(I,3)
54 Z2 = COORD(J,3)
55 Z3 = COORD(K,3)
56 Z4 = COORD(L,3)
57
58 XC = XC + x1 + x2 + x3 + x4
59 YC = YC + y1 + y2 + y3 + y4
60 ZC = ZC + z1 + z2 + z3 + z4
61 END DO
62 CENT(1) = XC / (4*NSEG)
63 CENT(2) = YC / (4*NSEG)
64 CENT(3) = ZC / (4*NSEG)
65 END IF
66
67 X5 = CENT(1)
68 Y5 = CENT(2)
69 Z5 = CENT(3)
70
71 DO 100 KSEG = 1 , NSEG
72 L = LSTSN(4*KSEG)
73 K = LSTSN(4*KSEG - 1)
74 J = LSTSN(4*KSEG - 2)
75 I = LSTSN(4*KSEG - 3)
76
77 X1 = COORD(I,1)
78 X2 = COORD(J,1)
79 X3 = COORD(K,1)
80 X4 = COORD(L,1)
81
82 Y1 = COORD(I,2)
83 Y2 = COORD(J,2)
84 Y3 = COORD(K,2)
85 Y4 = COORD(L,2)
86
87 Z1 = COORD(I,3)
88 Z2 = COORD(J,3)
89 Z3 = COORD(K,3)
90 Z4 = COORD(L,3)
91
92 Z13 = Z1 - Z3
93 Z24 = Z2 - Z4
94 Z31 = Z3 - Z1
95 Z42 = Z4 - Z2
96 Z51 = Z5 - Z1
97 Z52 = Z5 - Z2
98 Z53 = Z5 - Z3
99 Z54 = Z5 - Z4
100
101 VP = ((2.*Y5 - Y3) * Z42 + Y2 * (Z53 + Z54) -
102 * Y4 * (Z53 + Z52) ) * X1 +
103 * ( (Y4 - 2.*Y5) * Z31 + Y3 * (Z54 + Z51) -
104 * Y1 * (Z54 + Z53) ) * X2 +
105 * ( (Y1 - 2.*Y5) * Z42 + Y4 * (Z51 + Z52) -
106 * Y2 * (Z54 + Z51) ) * X3 +
107 * ( (2.*Y5 - Y2) * Z31 + Y1 * (Z52 + Z53) -
108 * Y3 * (Z52 + Z51) ) * X4 +
109 * ((Y2 - Y4) * (Z3 - Z1) + (Y3 - Y1) *(Z4 - Z2)) * 2. * X5
110 VOLUME = VOLUME + VP / 12.0
111 100 CONTINUE
112
113 RETURN
114 END