39
40
41
42#include "implicit_f.inc"
43
44
45
46#include "mvsiz_p.inc"
47
48
49
50 INTEGER, INTENT (IN) :: NEL
51 INTEGER, INTENT (OUT) :: IFCTL
52 INTEGER, DIMENSION(MVSIZ),INTENT (INOUT) :: IFC1
53 my_real,
DIMENSION(MVSIZ),
INTENT (INOUT) :: stif
54 my_real,
DIMENSION(MVSIZ),
INTENT (IN) :: fld ,
55 4 vx1, vx2, vx3, vx4,
56 5 vx5, vx6, vx7, vx8,
57 6 vy1, vy2, vy3, vy4,
58 7 vy5, vy6, vy7, vy8,
59 8 vz1, vz2, vz3, vz4,
60 9 vz5, vz6, vz7, vz8
61 my_real,
DIMENSION(MVSIZ,3),
INTENT (IN) :: vc
62 my_real,
DIMENSION(MVSIZ,3),
INTENT (INOUT) ::
63 . for_t1, for_t2, for_t3, for_t4,
64 . for_t5, for_t6, for_t7, for_t8
65 my_real,
INTENT (IN) :: tol_v,mu,dt1
66 my_real,
DIMENSION(NEL),
INTENT(INOUT) :: e_distor
67
68
69
70
71
72
73 INTEGER I,J,IFCONT
74
76 . vre(6),vxc,vyc,vzc,fx,fy,fz,fac,vnj(8),vl,tol_v2,
77 . vxmax,vymax,vzmax,v2max,vc2,lam_min,lam_min2,lam_max
78
79 tol_v2 = tol_v*tol_v
80 ifctl = 0
81 ifcont = 1
82 DO i=1,nel
83 vc2 = vc(i,1)*vc(i,1)+vc(i,2)*vc(i,2)+vc(i,3)*vc(i,3)
84 IF (vc2 <em20.OR.stif(i)==zero) cycle
85 vl = tol_v2*vc2
86 vnj(1) = vx1(i)*vx1(i) + vy1(i)*vy1(i) + vz1(i)*vz1(i)
87 vnj(2) = vx2(i)*vx2(i) + vy2(i)*vy2(i) + vz2(i)*vz2(i)
88 vnj(3) = vx3(i)*vx3(i) + vy3(i)*vy3(i) + vz3(i)*vz3(i)
89 vnj(4) = vx4(i)*vx4(i) + vy4(i)*vy4(i) + vz4(i)*vz4(i)
90 vnj(5) = vx5(i)*vx5(i) + vy5(i)*vy5(i) + vz5(i)*vz5(i)
91 vnj(6) = vx6(i)*vx6(i) + vy6(i)*vy6(i) + vz6(i)*vz6(i)
92 vnj(7) = vx7(i)*vx7(i) + vy7(i)*vy7(i) + vz7(i)*vz7(i)
93 vnj(8) = vx8(i)*vx8(i) + vy8(i)*vy8(i) + vz8(i)*vz8(i)
94 v2max =
max(vnj(1),vnj(2),vnj(3),vnj(4))
95 v2max =
max(v2max,vnj(5),vnj(6),vnj(7),vnj(8))
96 IF (v2max > vl) ifc1(i) = 1
97 IF (ifc1(i) > 0) ifctl=1
98
99 END DO
100
101 IF (ifctl==1) THEN
102 fac = one + two*mu
103 DO i=1,nel
104 IF (ifc1(i)==0) cycle
105 for_t1(i,1) = for_t1(i,1) - fld(i)*(vx1(i)-vc(i,1))
106 for_t1(i,2) = for_t1(i,2) - fld(i)*(vy1(i)-vc(i,2))
107 for_t1(i,3) = for_t1(i,3) - fld(i)*(vz1(i)-vc(i,3))
108 for_t2(i,1) = for_t2(i,1) - fld(i)*(vx2(i)-vc(i,1))
109 for_t2(i,2) = for_t2(i,2) - fld(i)*(vy2(i)-vc(i,2))
110 for_t2(i,3) = for_t2(i,3) - fld(i)*(vz2(i)-vc(i,3))
111 for_t3(i,1) = for_t3(i,1) - fld(i)*(vx3(i)-vc(i,1))
112 for_t3(i,2) = for_t3(i,2) - fld(i)*(vy3(i)-vc(i,2))
113 for_t3(i,3) = for_t3(i,3) - fld(i)*(vz3(i)-vc(i,3))
114 for_t4(i,1) = for_t4(i,1) - fld(i)*(vx4(i)-vc(i,1))
115 for_t4(i,2) = for_t4(i,2) - fld(i)*(vy4(i)-vc(i,2))
116 for_t4(i,3) = for_t4(i,3) - fld(i)*(vz4(i)-vc(i,3))
117 for_t5(i,1) = for_t5(i,1) - fld(i)*(vx5(i)-vc(i,1))
118 for_t5(i,2) = for_t5(i,2) - fld(i)*(vy5(i)-vc(i,2))
119 for_t5(i,3) = for_t5(i,3) - fld(i)*(vz5(i)-vc(i,3))
120 for_t6(i,1) = for_t6(i,1) - fld(i)*(vx6(i)-vc(i,1))
121 for_t6(i,2) = for_t6(i,2) - fld(i)*(vy6(i)-vc(i,2))
122 for_t6(i,3) = for_t6(i,3) - fld(i)*(vz6(i)-vc(i,3))
123 for_t7(i,1) = for_t7(i,1) - fld(i)*(vx7(i)-vc(i,1))
124 for_t7(i,2) = for_t7(i,2) - fld(i)*(vy7(i)-vc(i,2))
125 for_t7(i,3) = for_t7(i,3) - fld(i)*(vz7(i)-vc(i,3))
126 for_t8(i,1) = for_t8(i,1) - fld(i)*(vx8(i)-vc(i,1))
127 for_t8(i,2) = for_t8(i,2) - fld(i)*(vy8(i)-vc(i,2))
128 for_t8(i,3) = for_t8(i,3) - fld(i)*(vz8(i)-vc(i,3))
129 stif(i) = fac*stif(i)
130 e_distor(i)=e_distor(i) -dt1*(for_t1(i,1)*(vx1(i)-vc(i,1))+
131 . for_t1(i,2)*(vy1(i)-vc(i,2))+
132 . for_t1(i,3)*(vz1(i)-vc(i,3))+
133 . for_t2(i,1)*(vx2(i)-vc(i,1))+
134 . for_t2(i,2)*(vy2(i)-vc(i,2))+
135 . for_t2(i,3)*(vz2(i)-vc(i,3))+
136 . for_t3(i,1)*(vx3(i)-vc(i,1))+
137 . for_t3(i,2)*(vy3(i)-vc(i,2))+
138 . for_t3(i,3)*(vz3(i)-vc(i,3))+
139 . for_t4(i,1)*(vx4(i)-vc(i,1))+
140 . for_t4(i,2)*(vy4(i)-vc(i,2))+
141 . for_t4(i,3)*(vz4(i)-vc(i,3))+
142 . for_t5(i,1)*(vx5(i)-vc(i,1))+
143 . for_t5(i,2)*(vy5(i)-vc(i,2))+
144 . for_t5(i,3)*(vz5(i)-vc(i,3))+
145 . for_t6(i,1)*(vx6(i)-vc(i,1))+
146 . for_t6(i,2)*(vy6(i)-vc(i,2))+
147 . for_t6(i,3)*(vz6(i)-vc(i,3))+
148 . for_t7(i,1)*(vx7(i)-vc(i,1))+
149 . for_t7(i,2)*(vy7(i)-vc(i,2))+
150 . for_t7(i,3)*(vz7(i)-vc(i,3))+
151 . for_t8(i,1)*(vx8(i)-vc(i,1))+
152 . for_t8(i,2)*(vy8(i)-vc(i,2))+
153 . for_t8(i,3)*(vz8(i)-vc(i,3)))
154 ENDDO
155 END IF
156
157 ifctl = ifcont
158
159 RETURN