32
33
34
35
36
37
38
39
40#include "implicit_f.inc"
41
42
43
44
45
46
47
48 INTEGER, INTENT(IN) :: NEL, NFT, JALE, SYM, IXTG(NIXTG, *)
50 . xgrid(3, *), wgrid(*)
51 my_real,
INTENT(OUT) :: wfac(3, 3, nel), surf(3, nel)
53
54
55
56 INTEGER :: II, NODE1, NODE2, NODE3, KFACE
58 . x1(3), x2(3), x3(3), xk(3), xf(1:3),
59 . w1(3), w2(3), w3(3)
61
62 DO ii = 1, nel
63 node1 = ixtg(2, ii + nft)
64 node2 = ixtg(3, ii + nft)
65 node3 = ixtg(4, ii + nft)
66 x1(1:3) = xgrid(1:3, node1)
67 x2(1:3) = xgrid(1:3, node2)
68 x3(1:3) = xgrid(1:3, node3)
69 xk(1:3) = third * (x1(1:3) + x2(1:3) + x3(1:3))
70 IF (jale /= 0) THEN
71
72 w1(1:3) = wgrid(3 * (node1 - 1) + 1 : 3 * (node1 - 1) + 3)
73 w2(1:3) = wgrid(3 * (node2 - 1) + 1 : 3 * (node2 - 1) + 3)
74 w3(1:3) = wgrid(3 * (node3 - 1) + 1 : 3 * (node3 - 1) + 3)
75 ELSE
76 w1(1:3) = zero
77 w2(1:3) = zero
78 w3(1:3) = zero
79 ENDIF
80
81
82 kface = 1
83 norm(1, kface, ii) = zero
84 norm(2, kface, ii) = x2(3) - x1(3)
85 norm(3, kface, ii) = -(x2(2) - x1(2))
86 nx =>
norm(1, kface, ii)
87 ny =>
norm(2, kface, ii)
88 nz =>
norm(3, kface, ii)
89 surf(kface, ii) = sqrt(ny * ny + nz * nz)
90 ny = ny / surf(kface, ii)
91 nz = nz / surf(kface, ii)
92 IF (sym == 1) THEN
93 surf(kface, ii) = surf(kface, ii) * half * (x1(2) + x2(2))
94 ENDIF
95 xf(1:3) = half * (x1(1:3) + x2(1:3))
96 IF (nx * (xf(1) - xk(1)) + ny * (xf(2) - xk(2)) + nz * (xf(3) - xk(3)) <= zero) THEN
98 ENDIF
99
100 kface = 2
101 norm(1, kface, ii) = zero
102 norm(2, kface, ii) = x3(3) - x2(3)
103 norm(3, kface, ii) = -(x3(2) - x2(2))
104 nx =>
norm(1, kface, ii)
105 ny =>
norm(2, kface, ii)
106 nz =>
norm(3, kface, ii)
107 surf(kface, ii) = sqrt(ny * ny + nz * nz)
108 ny = ny / surf(kface, ii)
109 nz = nz / surf(kface, ii)
110 IF (sym == 1) THEN
111 surf(kface, ii) = surf(kface, ii) * half * (x2(2) + x3(2))
112 ENDIF
113 xf(1:3) = half * (x2(1:3) + x3(1:3))
114 IF (nx * (xf(1) - xk(1)) + ny * (xf(2) - xk(2)) + nz * (xf(3) - xk(3)) <= zero) THEN
116 ENDIF
117
118 kface = 3
119 norm(1, kface, ii) = zero
120 norm(2, kface, ii) = x1(3) - x3(3)
121 norm(3, kface, ii) = -(x1(2) - x3(2))
122 nx =>
norm(1, kface, ii)
123 ny =>
norm(2, kface, ii)
124 nz =>
norm(3, kface, ii)
125 surf(kface, ii) = sqrt(ny * ny + nz * nz)
126 ny = ny / surf(kface, ii)
127 nz = nz / surf(kface, ii)
128 IF (sym == 1) THEN
129 surf(kface, ii) = surf(kface, ii) * half * (x3(2) + x1(2))
130 ENDIF
131 xf(1:3) = half * (x3(1:3) + x1(1:3))
132 IF (nx * (xf(1) - xk(1)) + ny * (xf(2) - xk(2)) + nz * (xf(3) - xk(3)) <= zero) THEN
134 ENDIF
135
136 wfac(1:3, 1, ii) = half * (w1(1:3) + w2(1:3))
137
138 wfac(1:3, 2, ii) = half * (w2(1:3) + w3(1:3))
139
140 wfac(1:3, 3, ii) = half * (w3(1:3) + w1(1:3))
141 ENDDO
norm(diag(diag(diag(inv(mat))) -id.SOL), 2) % destroy mumps instance id.JOB