Debian Codegraph @

packages/seacas/applications/grepos/gp_setnor.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 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