34
35
36
37#include "implicit_f.inc"
38
39
40
41#include "mvsiz_p.inc"
42
43
44
45 INTEGER JFT,JLT,IREP
47 . rx(mvsiz) , ry(mvsiz) , rz(mvsiz),
48 . sx(mvsiz) , sy(mvsiz) , sz(mvsiz),
49 . e1x(mvsiz), e1y(mvsiz), e1z(mvsiz),
50 . e2x(mvsiz), e2y(mvsiz), e2z(mvsiz),
51 . e3x(mvsiz), e3y(mvsiz), e3z(mvsiz), det(mvsiz)
52
53
54
55 INTEGER I
57
58
59
60 DO i=jft,jlt
61
62 e3x(i) = ry(i) * sz(i) - rz(i) * sy(i)
63 e3y(i) = rz(i) * sx(i) - rx(i) * sz(i)
64 e3z(i) = rx(i) * sy(i) - ry(i) * sx(i)
65 det(i) = sqrt(e3x(i)*e3x(i) + e3y(i)*e3y(i) + e3z(i)*e3z(i))
66 det(i) =
max(em20,det(i))
67 cc = one / det(i)
68 e3x(i) = e3x(i) * cc
69 e3y(i) = e3y(i) * cc
70 e3z(i) = e3z(i) * cc
71 ENDDO
72
73 IF (irep==2) THEN
74 DO i=jft,jlt
75 e1x(i) = rx(i)
76 e1y(i) = ry(i)
77 e1z(i) = rz(i)
78 ENDDO
79 ELSEIF (irep==1) THEN
80 DO i=jft,jlt
81 c2 = sqrt(sx(i)*sx(i) + sy(i)*sy(i) + sz(i)*sz(i))
82 e1x(i) = rx(i)*c2+(sy(i)*e3z(i)-sz(i)*e3y(i))
83 e1y(i) = ry(i)*c2+(sz(i)*e3x(i)-sx(i)*e3z(i))
84 e1z(i) = rz(i)*c2+(sx(i)*e3y(i)-sy(i)*e3x(i))
85 ENDDO
86 ELSE
87 DO i=jft,jlt
88 c1 = sqrt(rx(i)*rx(i) + ry(i)*ry(i) + rz(i)*rz(i))
89 c2 = sqrt(sx(i)*sx(i) + sy(i)*sy(i) + sz(i)*sz(i))
90 e1x(i) = rx(i)*c2+(sy(i)*e3z(i)-sz(i)*e3y(i))*c1
91 e1y(i) = ry(i)*c2+(sz(i)*e3x(i)-sx(i)*e3z(i))*c1
92 e1z(i) = rz(i)*c2+(sx(i)*e3y(i)-sy(i)*e3x(i))*c1
93 ENDDO
94 ENDIF
95
96 DO i=jft,jlt
97 c1 = sqrt(e1x(i)*e1x(i) + e1y(i)*e1y(i) + e1z(i)*e1z(i))
98 IF (c1/=zero) c1 = one / c1
99 e1x(i) = e1x(i)*c1
100 e1y(i) = e1y(i)*c1
101 e1z(i) = e1z(i)*c1
102 e2x(i) = e3y(i) * e1z(i) - e3z(i) * e1y(i)
103 e2y(i) = e3z(i) * e1x(i) - e3x(i) * e1z(i)
104 e2z(i) = e3x(i) * e1y(i) - e3y(i) * e1x(i)
105 ENDDO
106
107 RETURN