74{
75 G4double R[3] = { P[0], P[1] , P[2]};
76 G4double A[3] = {dPdS[0], dPdS[1], dPdS[2]};
77
78 m_iPoint[0]=R[0]; m_iPoint[1]=R[1]; m_iPoint[2]=R[2];
79
85
86
87
88
89
90
91
92
93
94 G4double K1[3] = { m_imom*dPdS[3], m_imom*dPdS[4], m_imom*dPdS[5] };
95
96
97
98 G4double p[4] = {R[0]+S5*(A[0]+S4*K1[0]),
99 R[1]+S5*(A[1]+S4*K1[1]),
100 R[2]+S5*(A[2]+S4*K1[2]),
101 P[7] };
102 getField(p);
103
104 G4double A2[3] = {A[0]+S5*K1[0],A[1]+S5*K1[1],A[2]+S5*K1[2]};
105 G4double K2[3] = {(A2[1]*m_lastField[2]-A2[2]*m_lastField[1])*m_cof,
106 (A2[2]*m_lastField[0]-A2[0]*m_lastField[2])*m_cof,
107 (A2[0]*m_lastField[1]-A2[1]*m_lastField[0])*m_cof};
108
109 m_mPoint[0]=p[0]; m_mPoint[1]=p[1]; m_mPoint[2]=p[2];
110
111
112
113 G4double A3[3] = {A[0]+S5*K2[0],A[1]+S5*K2[1],A[2]+S5*K2[2]};
114 G4double K3[3] = {(A3[1]*m_lastField[2]-A3[2]*m_lastField[1])*m_cof,
115 (A3[2]*m_lastField[0]-A3[0]*m_lastField[2])*m_cof,
116 (A3[0]*m_lastField[1]-A3[1]*m_lastField[0])*m_cof};
117
118
119
120 p[0] = R[0]+S*(A[0]+S5*K3[0]);
121 p[1] = R[1]+S*(A[1]+S5*K3[1]);
122 p[2] = R[2]+S*(A[2]+S5*K3[2]);
123
124 getField(p);
125
126 G4double A4[3] = {A[0]+S*K3[0],A[1]+S*K3[1],A[2]+S*K3[2]};
127 G4double K4[3] = {(A4[1]*m_lastField[2]-A4[2]*m_lastField[1])*m_cof,
128 (A4[2]*m_lastField[0]-A4[0]*m_lastField[2])*m_cof,
129 (A4[0]*m_lastField[1]-A4[1]*m_lastField[0])*m_cof};
130
131
132
133 Po[0] = P[0]+S*(A[0]+S6*(K1[0]+K2[0]+K3[0]));
134 Po[1] = P[1]+S*(A[1]+S6*(K1[1]+K2[1]+K3[1]));
135 Po[2] = P[2]+S*(A[2]+S6*(K1[2]+K2[2]+K3[2]));
136
137 m_fPoint[0]=Po[0]; m_fPoint[1]=Po[1]; m_fPoint[2]=Po[2];
138
139
140
141 Po[3] = A[0]+S6*(K1[0]+K4[0]+2.*(K2[0]+K3[0]));
142 Po[4] = A[1]+S6*(K1[1]+K4[1]+2.*(K2[1]+K3[1]));
143 Po[5] = A[2]+S6*(K1[2]+K4[2]+2.*(K2[2]+K3[2]));
144
145
146
147 Err[3] = S*std::fabs(K1[0]-K2[0]-K3[0]+K4[0]);
148 Err[4] = S*std::fabs(K1[1]-K2[1]-K3[1]+K4[1]);
149 Err[5] = S*std::fabs(K1[2]-K2[2]-K3[2]+K4[2]);
150 Err[0] = S*Err[3] ;
151 Err[1] = S*Err[4] ;
152 Err[2] = S*Err[5] ;
153 Err[3]*= m_mom ;
154 Err[4]*= m_mom ;
155 Err[5]*= m_mom ;
156
157
158
159 G4double normF = m_mom/std::sqrt(Po[3]*Po[3]+Po[4]*Po[4]+Po[5]*Po[5]);
160 Po [3]*=normF; Po[4]*=normF; Po[5]*=normF;
161
162
163 Po[6]=P[6]; Po[7]=P[7];
164}