39
40
41
42
43
44
45
46
47
49
50
51
52#include "implicit_f.inc"
53
54
55
56#include "mvsiz_p.inc"
57
58
59
60#include "com08_c.inc"
61
62
63
64 INTEGER IRECT(4,*), NSV(*), CAND_E(*), CAND_N(*),
65 . JLT,IDT, NOINT, NSN ,ITYP, NIN,IEDGE
66 INTEGER IX1(MVSIZ), IX2(MVSIZ), IX3(MVSIZ), IX4(MVSIZ)
67 my_real ,
INTENT(IN) :: dgapload
69 . x(3,*), v(3,*), gapv(*), gap_s(*), gap_m(*),curv_max(*),
70 . pene_old(5,nsn), gapve(*),edge_l2(*)
72 . x1(mvsiz), x2(mvsiz), x3(mvsiz), x4(mvsiz),
73 . y1(mvsiz), y2(mvsiz), y3(mvsiz), y4(mvsiz),
74 . z1(mvsiz), z2(mvsiz), z3(mvsiz), z4(mvsiz),
75 . xi(mvsiz), yi(mvsiz), zi(mvsiz), stif(mvsiz)
76
77
78
79 INTEGER I , ,IL, L, NN, IG,JFT,IADD
81 . vdt(mvsiz),pene_l(mvsiz)
83 . vx,vy,vz,vxi,vyi,vzi,
84 . vx1,vx2,vx3,vx4,vy1,vy2,vy3,vy4,vz1,vz2,vz3,vz4,pmax
85
86
87 vdt = zero
88 gapve(1:jlt) = zero
89
90 DO i=1,jlt
91 j = cand_n(i)
92 IF(j<=nsn) THEN
93 gapv(i)=gap_s(j) + gap_m(cand_e(i))
94 ELSE
95 ig = j-nsn
96 gapv(i)=xrem(9,ig) + gap_m(cand_e(i))
97 END IF
98 gapv(i) =gapv(i) + dgapload
99 END DO
100 DO i=1,jlt
101 j = cand_n(i)
102 IF(j<=nsn) THEN
103 ig = nsv(j)
104 xi(i) = x(1,ig)
105 yi(i) = x(2,ig)
106 zi(i) = x(3,ig)
107 vxi = v(1,ig)
108 vyi = v(2,ig)
109 vzi = v(3,ig)
110 pene_l(i) = pene_old(3,j)
111 ELSE
112 ig = j-nsn
113 xi(i) = xrem(1,ig)
114 yi(i) = xrem(2,ig)
115 zi(i) = xrem(3,ig)
116 vxi = xrem(4,ig)
117 vyi = xrem(5,ig)
118 vzi = xrem(6,ig)
120 ENDIF
121
122 l = cand_e(i)
123
124 ix1(i)=irect(1,l)
125 x1(i)=x(1,ix1(i))
126 y1(i)=x(2,ix1(i))
127 z1(i)=x(3,ix1(i))
128
129 ix2(i)=irect(2,l)
130 x2(i)=x(1,ix2(i))
131 y2(i)=x(2,ix2(i))
132 z2(i)=x(3,ix2(i))
133
134 ix3(i)=irect(3,l)
135 x3(i)=x(1,ix3(i))
136 y3(i)=x(2,ix3(i))
137 z3(i)=x(3,ix3(i))
138
139 ix4(i)=irect(4,l)
140 x4(i)=x(1,ix4(i))
141 y4(i)=x(2,ix4(i))
142 z4(i)=x(3,ix4(i))
143
144 vx1 = v(1,ix1(i))
145 vx2 = v(1,ix2(i))
146 vx3 = v(1,ix3(i))
147 vx4 = v(1,ix4(i))
148 vx=
max(
max(vx1,vx2,vx3,vx4)-vxi,vxi-
min(vx1,vx2,vx3,vx4))
149 vy1 = v(2,ix1(i))
150 vy2 = v(2,ix2(i))
151 vy3 = v(2,ix3(i))
152 vy4 = v(2,ix4(i))
153 vy=
max(
max(vy1,vy2,vy3,vy4)-vyi,vyi-
min(vy1,vy2,vy3,vy4))
154 vz1 = v(3,ix1(i))
155 vz2 = v(3,ix2(i))
156 vz3 = v(3,ix3(i))
157 vz4 = v(3,ix4(i))
158 vz=
max(
max(vz1,vz2,vz3,vz4)-vzi,vzi-
min(vz1,vz2,vz3,vz4))
159 vdt(i) = (vx+vy+vz)*dt1
160 ENDDO
161
162 IF(iedge/=0)THEN
163 DO i=1,jlt
164 gapve(i) = gapv(i) + vdt(i) + edge_l2(cand_n(i))
165 END DO
166 ENDIF
167
168 DO i=1,jlt
169 gapv(i) =
max(gapv(i),pene_l(i)) + curv_max(cand_e(i)) + vdt(i)
170 gapv(i) = onep01*gapv(i)
171
172 END DO
173
174 RETURN