| 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 SETNOR (ISPLANE, NUMNP, X, Y, Z, IDIM, VNORM, NRMTYP, |
| 9 |
* PRJVEC, NEESS, NNESS, LTNESS) |
| 10 |
C======================================================================= |
| 11 |
|
| 12 |
include 'gp_snap.blk' |
| 13 |
|
| 14 |
LOGICAL ISPLANE |
| 15 |
INTEGER NRMTYP |
| 16 |
|
| 17 |
REAL X(*), Y(*), Z(*), VNORM(IDIM,*), PRJVEC(3) |
| 18 |
DIMENSION LTNESS(4,*) |
| 19 |
|
| 20 |
IF (NRMTYP .EQ. PNORM .OR. ISPLANE) THEN |
| 21 |
DO 20 ISEG = 1, NEESS |
| 22 |
XI = X(LTNESS(1,ISEG)) |
| 23 |
YI = Y(LTNESS(1,ISEG)) |
| 24 |
ZI = Z(LTNESS(1,ISEG)) |
| 25 |
|
| 26 |
XJ = X(LTNESS(2,ISEG)) |
| 27 |
YJ = Y(LTNESS(2,ISEG)) |
| 28 |
ZJ = Z(LTNESS(2,ISEG)) |
| 29 |
|
| 30 |
XK = X(LTNESS(3,ISEG)) |
| 31 |
YK = Y(LTNESS(3,ISEG)) |
| 32 |
ZK = Z(LTNESS(3,ISEG)) |
| 33 |
|
| 34 |
XL = X(LTNESS(4,ISEG)) |
| 35 |
YL = Y(LTNESS(4,ISEG)) |
| 36 |
ZL = Z(LTNESS(4,ISEG)) |
| 37 |
|
| 38 |
AI = (YK - YI) * (ZL - ZJ) - (ZK - ZI) * (YL - YJ) |
| 39 |
BJ = (ZK - ZI) * (XL - XJ) - (XK - XI) * (ZL - ZJ) |
| 40 |
CK = (XK - XI) * (YL - YJ) - (YK - YI) * (XL - XJ) |
| 41 |
RMAG = SQRT ( AI**2 + BJ**2 + CK**2) |
| 42 |
|
| 43 |
AI = AI / RMAG |
| 44 |
BJ = BJ / RMAG |
| 45 |
CK = CK / RMAG |
| 46 |
|
| 47 |
if (isplane) then |
| 48 |
vnorm(1, iseg) = ai |
| 49 |
vnorm(2, iseg) = bj |
| 50 |
vnorm(3, iseg) = ck |
| 51 |
di = ai * xi + bj * yi + ck * zi |
| 52 |
dj = ai * xj + bj * yj + ck * zj |
| 53 |
dk = ai * xk + bj * yk + ck * zk |
| 54 |
dl = ai * xl + bj * yl + ck * zl |
| 55 |
vnorm(4,iseg) = (di + dj + dk + dl) / 4.0 |
| 56 |
else |
| 57 |
DO 10 INOD = 1, 4 |
| 58 |
NODE = LTNESS(INOD, ISEG) |
| 59 |
VNORM(1, NODE) = VNORM(1, NODE) + AI |
| 60 |
VNORM(2, NODE) = VNORM(2, NODE) + BJ |
| 61 |
VNORM(3, NODE) = VNORM(3, NODE) + CK |
| 62 |
10 CONTINUE |
| 63 |
end if |
| 64 |
20 CONTINUE |
| 65 |
|
| 66 |
if (isplane) return |
| 67 |
|
| 68 |
C ... NORMALIZE PRJVECS |
| 69 |
do 30 i=1, neess |
| 70 |
do 25 j=1,4 |
| 71 |
node = ltness(j, i) |
| 72 |
A = VNORM(1,NODE) |
| 73 |
B = VNORM(2,NODE) |
| 74 |
C = VNORM(3,NODE) |
| 75 |
R = A**2 + B**2 + C**2 |
| 76 |
IF (R .GT. 0.0) THEN |
| 77 |
R = SQRT(R) |
| 78 |
VNORM(1,NODE) = A/R |
| 79 |
VNORM(2,NODE) = B/R |
| 80 |
VNORM(3,NODE) = C/R |
| 81 |
END IF |
| 82 |
25 continue |
| 83 |
30 CONTINUE |
| 84 |
|
| 85 |
ELSE IF (NRMTYP .EQ. PRAD) THEN |
| 86 |
C ... Radial Projection |
| 87 |
do 70 i=1, neess |
| 88 |
do 60 j=1,4 |
| 89 |
node = ltness(j, i) |
| 90 |
a = x(node) - prjvec(1) |
| 91 |
b = y(node) - prjvec(2) |
| 92 |
c = z(node) - prjvec(3) |
| 93 |
R = sqrt(a**2 + b**2 + c**2) |
| 94 |
if (r .eq. 0) r = 1.0 |
| 95 |
vnorm(1,node) = a/r |
| 96 |
vnorm(2,node) = b/r |
| 97 |
vnorm(3,node) = c/r |
| 98 |
60 continue |
| 99 |
70 continue |
| 100 |
|
| 101 |
ELSE IF (NRMTYP .EQ. PVECT) THEN |
| 102 |
C ... Use user-supplied normal |
| 103 |
R = SQRT(PRJVEC(1)**2 + PRJVEC(2)**2 + PRJVEC(3)**2) |
| 104 |
PRJVEC(1) = PRJVEC(1)/R |
| 105 |
PRJVEC(2) = PRJVEC(2)/R |
| 106 |
PRJVEC(3) = PRJVEC(3)/R |
| 107 |
do 50 i=1, neess |
| 108 |
do 40 j=1,4 |
| 109 |
node = ltness(j, i) |
| 110 |
vnorm(1,node) = prjvec(1) |
| 111 |
vnorm(2,node) = prjvec(2) |
| 112 |
vnorm(3,node) = prjvec(3) |
| 113 |
40 continue |
| 114 |
50 continue |
| 115 |
|
| 116 |
ELSE IF (NRMTYP .EQ. PEDGE) THEN |
| 117 |
|
| 118 |
END IF |
| 119 |
RETURN |
| 120 |
END |