| 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 |