32
33
34
35#include "implicit_f.inc"
36
37
38
39 INTEGER MSR
40
42 . x(3,*), rwl(*),xmin ,ymin ,zmin ,xmax ,
ymax , zmax
43
44
45
46 INTEGER I
47
49 . xwl, ywl, zwl,xn,yn,zn,d,dx,dy,dz,xl, r, v1, v2, v3, vv1,
50 . vv2, vv3, vv, x0, y0, z0,
alpha, s, c
51 REAL R4
52
53 xn =rwl(1)
54 yn =rwl(2)
55 zn =rwl(3)
56 IF(msr==0)THEN
57 xwl=rwl(4)
58 ywl=rwl(5)
59 zwl=rwl(6)
60 ELSE
61 xwl=x(1,msr)
62 ywl=x(2,msr)
63 zwl=x(3,msr)
64 ENDIF
65
66 dx = xmax - xmin
68 dz = zmax - zmin
69
70 r = half*rwl(7)
71 xl = half*
max(dx,dy,dz)
72 v1 = zero
73 v2 = zep707
74 v3 = zep707
75 vv1 = v2 * zn - v3 * yn
76 vv2 = v3 * xn - v1 * zn
77 vv3 = v1 * yn - v2 * xn
78 vv = sqrt(vv1*vv1 + vv2*vv2 + vv3*vv3)
79 IF(vv<=half)THEN
80 v1 = zero
81 v2 = -zep707
82 v3 = zep707
83 vv1 = v2 * zn - v3 * yn
84 vv2 = v3 * xn - v1 * zn
85 vv3 = v1 * yn - v2 * xn
86 vv = sqrt(vv1*vv1 + vv2*vv2 + vv3*vv3)
87 ENDIF
88 vv1 = r*vv1/vv
89 vv2 = r*vv2/vv
90 vv3 = r*vv3/vv
91 v1 = vv2 * zn - vv3 * yn
92 v2 = vv3 * xn - vv1 * zn
93 v3 = vv1 * yn - vv2 * xn
94
95 x0 = xwl
96 y0 = ywl
97 z0 = zwl
99 DO i=1,24
102 r4 = x0 + vv1 * s + v1 * c - xn * xl
104 r4 = y0 + vv2 * s + v2 * c - yn * xl
106 r4 = z0 + vv3 * s + v3 * c - zn * xl
108 r4 = x0 + vv1 * s + v1 * c + xn * xl
110 r4 = y0 + vv2 * s + v2 * c + yn * xl
112 r4 = z0 + vv3 * s + v3 * c + zn * xl
115 ENDDO
116
117 RETURN
subroutine ymax(idn, fac, npc, pld, stiffmin, stiffmax, stiffini, stiffavg)
void write_r_c(float *w, int *len)