33
34
35
37 use element_mod , only : nixs
38
39
40
41#include "implicit_f.inc"
42
43
44
45#include "mvsiz_p.inc"
46
47
48
49#include "vect01_c.inc"
50#include "tabsiz_c.inc"
51
52
53
54
55
56
57
58
59
60
61
62 INTEGER,INTENT(IN) :: IXS(NIXS,SIXS/NIXS)
64 my_real,
INTENT(INOUT) :: grad(6,*)
65 TYPE(t_ale_connectivity), INTENT(IN) :: ALE_CONNECTIVITY
66
67
68
69 INTEGER I, II, IE, IV1, IV2, IV3, IV4, IV5, IV6, IAD2
71 . x1(mvsiz), x2(mvsiz), x3(mvsiz), x4(mvsiz), x5(mvsiz), x6(mvsiz), x7(mvsiz), x8(mvsiz),
72 . y1(mvsiz), y2(mvsiz), y3(mvsiz), y4(mvsiz), y5(mvsiz), y6(mvsiz), y7(mvsiz), y8(mvsiz), z1(mvsiz),
73 . z2(mvsiz), z3(mvsiz), z4(mvsiz), z5(mvsiz), z6(mvsiz), z7(mvsiz), z8(mvsiz), xc(mvsiz), yc(mvsiz),
74 . zc(mvsiz), n1x(mvsiz), n2x(mvsiz), n3x(mvsiz), n4x(mvsiz), n5x(mvsiz), n6x(mvsiz), n1y(mvsiz),
75 . n2y(mvsiz), n3y(mvsiz), n4y(mvsiz), n5y(mvsiz), n6y(mvsiz), n1z(mvsiz), n2z(mvsiz), n3z(mvsiz),
76 . n4z(mvsiz), n5z(mvsiz), n6z(mvsiz), dd1(mvsiz), dd2(mvsiz), dd3(mvsiz), dd4(mvsiz), dd5(mvsiz),
77 . dd6(mvsiz), d1x(mvsiz), d2x(mvsiz), d3x(mvsiz), d4x(mvsiz), d5x(mvsiz), d6x(mvsiz), d1y(mvsiz),
78 . d2y(mvsiz), d3y(mvsiz), d4y(mvsiz), d5y(mvsiz), d6y(mvsiz), d1z(mvsiz), d2z(mvsiz), d3z(mvsiz),
79 . d4z(mvsiz), d5z(mvsiz), d6z(mvsiz)
80
81
82
83 DO i=lft,llt
84 ii=i+nft
85 x1(i)=x(1,ixs(2,ii))
86 y1(i)=x(2,ixs(2,ii))
87 z1(i)=x(3,ixs(2,ii))
88
89 x2(i)=x(1,ixs(3,ii))
90 y2(i)=x(2,ixs(3,ii))
91 z2(i)=x(3,ixs(3,ii))
92
93 x3(i)=x(1,ixs(4,ii))
94 y3(i)=x(2,ixs(4,ii))
95 z3(i)=x(3,ixs(4,ii))
96
97 x4(i)=x(1,ixs(5,ii))
98 y4(i)=x(2,ixs(5,ii))
99 z4(i)=x(3,ixs(5,ii))
100
101 x5(i)=x(1,ixs(6,ii))
102 y5(i)=x(2,ixs(6,ii))
103 z5(i)=x(3,ixs(6,ii))
104
105 x6(i)=x(1,ixs(7,ii))
106 y6(i)=x(2,ixs(7,ii))
107 z6(i)=x(3,ixs(7,ii))
108
109 x7(i)=x(1,ixs(8,ii))
110 y7(i)=x(2,ixs(8,ii))
111 z7(i)=x(3,ixs(8,ii))
112
113 x8(i)=x(1,ixs(9,ii))
114 y8(i)=x(2,ixs(9,ii))
115 z8(i)=x(3,ixs(9,ii))
116 ENDDO
117
118
119
120 DO i=lft,llt
121 n1x(i) = (y3(i)-y1(i))*(z2(i)-z4(i)) - (z3(i)-z1(i))*(y2(i)-y4(i))
122 n1y(i) = (z3(i)-z1(i))*(x2(i)-x4(i)) - (x3(i)-x1(i))*(z2(i)-z4(i))
123 n1z(i) = (x3(i)-x1(i))*(y2(i)-y4(i)) - (y3(i)-y1(i))*(x2(i)-x4(i))
124
125 n2x(i) = (y7(i)-y4(i))*(z3(i)-z8(i)) - (z7(i)-z4(i))*(y3(i)-y8(i))
126 n2y(i) = (z7(i)-z4(i))*(x3(i)-x8(i)) - (x7(i)-x4(i))*(z3(i)-z8(i))
127 n2z(i) = (x7(i)-x4(i))*(y3(i)-y8(i)) - (y7(i)-y4(i))*(x3(i)-x8(i))
128
129 n3x(i) = (y6(i)-y8(i))*(z7(i)-z5(i)) - (z6(i)-z8(i))*(y7(i)-y5(i))
130 n3y(i) = (z6(i)-z8(i))*(x7(i)-x5(i)) - (x6(i)-x8(i))*(z7(i)-z5(i))
131 n3z(i) = (x6(i)-x8(i))*(y7(i)-y5(i)) - (y6(i)-y8(i))*(x7(i)-x5(i))
132
133 n4x(i) = (y2(i)-y5(i))*(z6(i)-z1(i)) - (z2(i)-z5(i))*(y6(i)-y1(i))
134 n4y(i) = (z2(i)-z5(i))*(x6(i)-x1(i)) - (x2(i)-x5(i))*(z6(i)-z1(i))
135 n4z(i) = (x2(i)-x5(i))*(y6(i)-y1(i)) - (y2(i)-y5(i))*(x6(i)-x1(i))
136
137 n5x(i) = (y7(i)-y2(i))*(z6(i)-z3(i)) - (z7(i)-z2(i))*(y6(i)-y3(i))
138 n5y(i) = (z7(i)-z2(i))*(x6(i)-x3(i)) - (x7(i)-x2(i))*(z6(i)-z3(i))
139 n5z(i) = (x7(i)-x2(i))*(y6(i)-y3(i)) - (y7(i)-y2(i))*(x6(i)-x3(i))
140
141 n6x(i) = (y8(i)-y1(i))*(z4(i)-z5(i)) - (z8(i)-z1(i))*(y4(i)-y5(i))
142 n6y(i) = (z8(i)-z1(i))*(x4(i)-x5(i)) - (x8(i)-x1(i))*(z4(i)-z5(i))
143 n6z(i) = (x8(i)-x1(i))*(y4(i)-y5(i)) - (y8(i)-y1(i))*(x4(i)-x5(i))
144
145 xc(i) = (x1(i)+x2(i)+x3(i)+x4(i)+x5(i)+x6(i)+x7(i)+x8(i))
146 yc(i) = (y1(i)+y2(i)+y3(i)+y4(i)+y5(i)+y6(i)+y7(i)+y8(i))
147 zc(i) = (z1(i)+z2(i)+z3(i)+z4(i)+z5(i)+z6(i)+z7(i)+z8(i))
148 ENDDO
149
150
151
152 DO i=lft,llt
153 ie =nft+i
154 iad2 = ale_connectivity%ee_connect%iad_connect(ie)
155 iv1=ale_connectivity%ee_connect%connected(iad2 + 1 - 1)
156 IF(iv1 <= 0) iv1=ie
157 d1x(i) = - xc(i)
158 . +x(1,ixs(2,iv1))+x(1,ixs(3,iv1))+x(1,ixs(4,iv1))+x(1,ixs(5,iv1))
159 . +x(1,ixs(6,iv1))+x(1,ixs(7,iv1))+x(1,ixs(8,iv1))+x(1,ixs(9,iv1))
160 d1y(i) = - yc(i)
161 . +x(2,ixs(2,iv1))+x(2,ixs(3,iv1))+x(2,ixs(4,iv1))+x(2,ixs(5,iv1))
162 . +x(2,ixs(6,iv1))+x(2,ixs(7,iv1))+x(2,ixs(8,iv1))+x(2,ixs(9,iv1))
163 d1z(i) = - zc(i)
164 . +x(3,ixs(2,iv1))+x(3,ixs(3,iv1))+x(3,ixs(4,iv1))+x(3,ixs(5,iv1))
165 . +x(3,ixs(6,iv1))+x(3,ixs(7,iv1))+x(3,ixs(8,iv1))+x(3,ixs(9,iv1))
166 ENDDO
167 DO i=lft,llt
168 ie =nft+i
169 iad2 = ale_connectivity%ee_connect%iad_connect(ie)
170 iv2=ale_connectivity%ee_connect%connected(iad2 + 2 - 1)
171 IF(iv2 <= 0) iv2=ie
172 d2x(i) = - xc(i)
173 . +x(1,ixs(2,iv2))+x(1,ixs(3,iv2))+x(1,ixs(4,iv2))+x(1,ixs(5,iv2))
174 . +x(1,ixs(6,iv2))+x(1,ixs(7,iv2))+x(1,ixs(8,iv2))+x(1,ixs(9,iv2))
175 d2y(i) = - yc(i)
176 . +x(2,ixs(2,iv2))+x(2,ixs(3,iv2))+x(2,ixs(4,iv2))+x(2,ixs(5,iv2))
177 . +x(2,ixs(6,iv2))+x(2,ixs(7,iv2))+x(2,ixs(8,iv2))+x(2,ixs(9,iv2))
178 d2z(i) = - zc(i)
179 . +x(3,ixs(2,iv2))+x(3,ixs(3,iv2))+x(3,ixs(4,iv2))+x(3,ixs(5,iv2))
180 . +x(3,ixs(6,iv2))+x(3,ixs(7,iv2))+x(3,ixs(8,iv2))+x(3,ixs(9,iv2))
181 ENDDO
182 DO i=lft,llt
183 ie =nft+i
184 iad2 = ale_connectivity%ee_connect%iad_connect(ie)
185 iv3=ale_connectivity%ee_connect%connected(iad2 + 3 - 1)
186 IF(iv3 <= 0) iv3=ie
187 d3x(i) = - xc(i)
188 . +x(1,ixs(2,iv3))+x(1,ixs(3,iv3))+x(1,ixs(4,iv3))+x(1,ixs(5,iv3))
189 . +x(1,ixs(6,iv3))+x(1,ixs(7,iv3))+x(1,ixs(8,iv3))+x(1,ixs(9,iv3))
190 d3y(i) = - yc(i)
191 . +x(2,ixs(2,iv3))+x(2,ixs(3,iv3))+x(2,ixs(4,iv3))+x(2,ixs(5,iv3))
192 . +x(2,ixs(6,iv3))+x(2,ixs(7,iv3))+x(2,ixs(8,iv3))+x(2,ixs(9,iv3))
193 d3z(i) = - zc(i)
194 . +x(3,ixs(2,iv3))+x(3,ixs(3,iv3))+x(3,ixs(4,iv3))+x(3,ixs(5,iv3))
195 . +x(3,ixs(6,iv3))+x(3,ixs(7,iv3))+x(3,ixs(8,iv3))+x(3,ixs(9,iv3))
196 ENDDO
197 DO i=lft,llt
198 ie =nft+i
199 iad2 = ale_connectivity%ee_connect%iad_connect(ie)
200 iv4=ale_connectivity%ee_connect%connected(iad2 + 4 - 1)
201 IF(iv4 <= 0) iv4=ie
202 d4x(i) = - xc(i)
203 . +x(1,ixs(2,iv4))+x(1,ixs(3,iv4))+x(1,ixs(4,iv4))+x(1,ixs(5,iv4))
204 . +x(1,ixs(6,iv4))+x(1,ixs(7,iv4))+x(1,ixs(8,iv4))+x(1,ixs(9,iv4))
205 d4y(i) = - yc(i)
206 . +x(2,ixs(2,iv4))+x(2,ixs(3,iv4))+x(2,ixs(4,iv4))+x(2,ixs(5,iv4))
207 . +x(2,ixs(6,iv4))+x(2,ixs(7,iv4))+x(2,ixs(8,iv4))+x(2,ixs(9,iv4))
208 d4z(i) = - zc(i)
209 . +x(3,ixs(2,iv4))+x(3,ixs(3,iv4))+x(3,ixs(4,iv4))+x(3,ixs(5,iv4))
210 . +x(3,ixs(6,iv4))+x(3,ixs(7,iv4))+x(3,ixs(8,iv4))+x(3,ixs(9,iv4))
211 ENDDO
212 DO i=lft,llt
213 ie =nft+i
214 iad2 = ale_connectivity%ee_connect%iad_connect(ie)
215 iv5=ale_connectivity%ee_connect%connected(iad2 + 5 - 1)
216 IF(iv5 <= 0) iv5=ie
217 d5x(i) = - xc(i)
218 . +x(1,ixs(2,iv5))+x(1,ixs(3,iv5))+x(1,ixs(4,iv5))+x(1,ixs(5,iv5))
219 . +x(1,ixs(6,iv5))+x(1,ixs(7,iv5))+x(1,ixs(8,iv5))+x(1,ixs(9,iv5))
220 d5y(i) = - yc(i)
221 . +x(2,ixs(2,iv5))+x(2,ixs(3,iv5))+x(2,ixs(4,iv5))+x(2,ixs(5,iv5))
222 . +x(2,ixs(6,iv5))+x(2,ixs(7,iv5))+x(2,ixs(8,iv5))+x(2,ixs(9,iv5))
223 d5z(i) = - zc(i)
224 . +x(3,ixs(2,iv5))+x(3,ixs(3,iv5))+x(3,ixs(4,iv5))+x(3,ixs(5,iv5))
225 . +x(3,ixs(6,iv5))+x(3,ixs(7,iv5))+x(3,ixs(8,iv5))+x(3,ixs(9,iv5))
226 ENDDO
227 DO i=lft,llt
228 ie =nft+i
229 iad2 = ale_connectivity%ee_connect%iad_connect(ie)
230 iv6=ale_connectivity%ee_connect%connected(iad2 + 6 - 1)
231 IF(iv6 <= 0) iv6=ie
232 d6x(i) = - xc(i)
233 . +x(1,ixs(2,iv6))+x(1,ixs(3,iv6))+x(1,ixs(4,iv6))+x(1,ixs(5,iv6))
234 . +x(1,ixs(6,iv6))+x(1,ixs(7,iv6))+x(1,ixs(8,iv6))+x(1,ixs(9,iv6))
235 d6y(i) = - yc(i)
236 . +x(2,ixs(2,iv6))+x(2,ixs(3,iv6))+x(2,ixs(4,iv6))+x(2,ixs(5,iv6))
237 . +x(2,ixs(6,iv6))+x(2,ixs(7,iv6))+x(2,ixs(8,iv6))+x(2,ixs(9,iv6))
238 d6z(i) = - zc(i)
239 . +x(3,ixs(2,iv6))+x(3,ixs(3,iv6))+x(3,ixs(4,iv6))+x(3,ixs(5,iv6))
240 . +x(3,ixs(6,iv6))+x(3,ixs(7,iv6))+x(3,ixs(8,iv6))+x(3,ixs(9,iv6))
241 ENDDO
242
243 DO i=lft,llt
244 dd1(i) = d1x(i)**2+d1y(i)**2+d1z(i)**2
245 dd2(i) = d2x(i)**2+d2y(i)**2+d2z(i)**2
246 dd3(i) = d3x(i)**2+d3y(i)**2+d3z(i)**2
247 dd4(i) = d4x(i)**2+d4y(i)**2+d4z(i)**2
248 dd5(i) = d5x(i)**2+d5y(i)**2+d5z(i)**2
249 dd6(i) = d6x(i)**2+d6y(i)**2+d6z(i)**2
250 ENDDO
251
252
253
254 DO i=lft,llt
255 grad(1,i)=four*
max(zero,d1x(i)*n1x(i) + d1y(i)*n1y(i)+d1z(i)*n1z(i)) /
max(em15,dd1(i))
256 grad(2,i)=four*
max(zero,d2x(i)*n2x(i) + d2y(i)*n2y(i)+d2z(i)*n2z(i)) /
max(em15,dd2(i))
257 grad(3,i)=four*
max(zero,d3x(i)*n3x(i) + d3y(i)*n3y(i)+d3z(i)*n3z(i)) /
max(em15,dd3(i))
258 grad(4,i)=four*
max(zero,d4x(i)*n4x(i) + d4y(i)*n4y(i)+d4z(i)*n4z(i)) /
max(em15,dd4(i))
259 grad(5,i)=four*
max(zero,d5x(i)*n5x(i) + d5y(i)*n5y(i)+d5z(i)*n5z(i)) /
max(em15,dd5(i))
260 grad(6,i)=four*
max(zero,d6x(i)*n6x(i) + d6y(i)*n6y(i)+d6z(i)*n6z(i)) /
max(em15,dd6(i))
261 ENDDO
262
263 RETURN