35
36
37
38#include "implicit_f.inc"
39
40
41
42
44 . x1, x2, x3, x4, x5, x6, x7, x8,
45 . y1, y2, y3, y4, y5, y6, y7, y8,
46 . z1, z2, z3, z4, z5, z6, z7, z8,
47 . e1x, e1y, e1z,
48 . e2x, e2y, e2z,
49 . e3x, e3y, e3z
50
51
52
53
54
55
57 . x17 , x28 , x35 , x46,
58 . y17 , y28 , y35 , y46,
59 . z17 , z28 , z35 , z46,
60 . a17 , a28 ,
61 . b17 , b28 ,
62 . c17 , c28 ,
63 . rx , ry , rz ,
64 . tx , ty , tz ,
65 . det,c1,c2
66
67 x17=x7-x1
68 x28=x8-x2
69 x35=x5-x3
70 x46=x6-x4
71 y17=y7-y1
72 y28=y8-y2
73 y35=y5-y3
74 y46=y6-y4
75 z17=z7-z1
76 z28=z8-z2
77 z35=z5-z3
78 z46=z6-z4
79
80 rx=x17+x28-x35-x46
81 ry=y17+y28-y35-y46
82 rz=z17+z28-z35-z46
83 a17=x17+x46
84 a28=x28+x35
85 b17=y17+y46
86 b28=y28+y35
87 c17=z17+z46
88 c28=z28+z35
89
90 tx=a17-a28
91 ty=b17-b28
92 tz=c17-c28
93
94
95
96 e3x = ty * rz - tz * ry
97 e3y = tz * rx - tx * rz
98 e3z = tx * ry - ty * rx
99
100 det = sqrt(e3x*e3x + e3y*e3y + e3z*e3z)
101 IF ( det/=zero) det = one / det
102 e3x = e3x * det
103 e3y = e3y * det
104 e3z = e3z * det
105
106 c1=sqrt(tx*tx+ty*ty+tz*tz)
107 c2=sqrt(rx*rx+ry*ry+rz*rz)
108 e1x=tx*c2 +(ry * e3z - rz * e3y)*c1
109 e1y=ty*c2 +(rz * e3x - rx * e3z)*c1
110 e1z=tz*c2 +(rx * e3y - ry * e3x)*c1
111 det = sqrt(e1x*e1x + e1y*e1y + e1z*e1z)
112 IF ( det/=zero) det = one / det
113 e1x = e1x*det
114 e1y = e1y*det
115 e1z = e1z*det
116
117 e2x = e3y * e1z - e3z * e1y
118 e2y = e3z * e1x - e3x * e1z
119 e2z = e3x * e1y - e3y * e1x
120
121 RETURN