64{
65
66
67
68
69
70
73
81
87
89
90
91
92
93 if( (std::fabs(R_1) < 1e-10)||(Bmag<1e-12) )
94 {
96
97
98
102 }
103 else
104 {
105 Bnorm = (1.0/Bmag)*Bfld;
106
107
108
109 B_x_P = Bnorm.
cross(initTangent);
110
111
112
113 B_d_P = Bnorm.
dot(initTangent);
114
115 vpar = B_d_P * Bnorm;
116 vperp= initTangent - vpar;
117
118 B_v_P = std::sqrt( 1 - B_d_P * B_d_P);
119
120
121
122 Theta = R_1 * h;
123
124
125
126 if( std::fabs(Theta) > approc_limit )
127 {
128 SinT = std::sin(Theta);
129 CosT = std::cos(Theta);
130 }
131 else
132 {
136 SinT = Theta - 1.0/6.0 * Theta3;
137 CosT = 1 - 0.5 * Theta2 + 1.0/24.0 * Theta4;
138 }
139
140
141
143
144 positionMove = R * ( SinT * vperp + (1-CosT) * B_x_P) + h * vpar;
145 endTangent = CosT * vperp + SinT * B_x_P + vpar;
146
147
148
149 yHelix[0] = yIn[0] + positionMove.
x();
150 yHelix[1] = yIn[1] + positionMove.
y();
151 yHelix[2] = yIn[2] + positionMove.
z();
152 yHelix[3] = velocityVal * endTangent.
x();
153 yHelix[4] = velocityVal * endTangent.
y();
154 yHelix[5] = velocityVal * endTangent.
z();
155
156
157
158 if(yHelix2)
159 {
160 SinT2 = 2.0 * SinT * CosT;
161 CosT2 = 1.0 - 2.0 * SinT * SinT;
162 endTangent = (CosT2 * vperp + SinT2 * B_x_P + vpar);
163 positionMove = R * ( SinT2 * vperp + (1-CosT2) * B_x_P) + h*2 * vpar;
164
165 yHelix2[0] = yIn[0] + positionMove.
x();
166 yHelix2[1] = yIn[1] + positionMove.
y();
167 yHelix2[2] = yIn[2] + positionMove.
z();
168 yHelix2[3] = velocityVal * endTangent.
x();
169 yHelix2[4] = velocityVal * endTangent.
y();
170 yHelix2[5] = velocityVal * endTangent.
z();
171 }
172
173
174
176
177 G4double particleCharge = fPtrMagEqOfMot->
FCof() / (eplus*c_light);
178 R_Helix =std::abs( ptan/(fUnitConstant * particleCharge*Bmag));
179
183 }
184}
CLHEP::Hep3Vector G4ThreeVector
Hep3Vector cross(const Hep3Vector &) const
double dot(const Hep3Vector &) const
void SetCurve(const G4double Curve)
void SetRadHelix(const G4double Rad)
G4double GetInverseCurve(const G4double Momentum, const G4double Bmag)
void LinearStep(const G4double yIn[], G4double h, G4double yHelix[]) const
void SetAngCurve(const G4double Ang)