Import Geant4 9.1.0 source tree
This commit is contained in:
@@ -24,8 +24,8 @@
|
||||
// ********************************************************************
|
||||
//
|
||||
//
|
||||
// $Id: G4MagHelicalStepper.cc,v 1.19 2007/05/18 15:48:42 tnikitin Exp $
|
||||
// GEANT4 tag $Name: geant4-09-00 $
|
||||
// $Id: G4MagHelicalStepper.cc,v 1.23 2007/09/05 12:20:17 gcosmo Exp $
|
||||
// GEANT4 tag $Name: geant4-09-01 $
|
||||
//
|
||||
// --------------------------------------------------------------------
|
||||
|
||||
@@ -37,65 +37,70 @@
|
||||
// (as in the normal runge-kutta-methods) is to add helix segments to the
|
||||
// current position
|
||||
|
||||
|
||||
// Constant for determining unit conversion when using normal as integrand.
|
||||
//
|
||||
const G4double G4MagHelicalStepper::fUnitConstant = 0.299792458*(GeV/(tesla*m));
|
||||
|
||||
|
||||
G4MagHelicalStepper::G4MagHelicalStepper(G4Mag_EqRhs *EqRhs)
|
||||
: G4MagIntegratorStepper(EqRhs, 6) // integrate over 6 variables only !!
|
||||
// position & velocity
|
||||
{
|
||||
fPtrMagEqOfMot = EqRhs;
|
||||
|
||||
}
|
||||
|
||||
G4MagHelicalStepper::~G4MagHelicalStepper()
|
||||
{
|
||||
}
|
||||
|
||||
// Constant for determining unit conversion when using normal as integrand.
|
||||
const G4double G4MagHelicalStepper::fUnitConstant = 0.299792458 * (GeV/(tesla*m));
|
||||
|
||||
void
|
||||
G4MagHelicalStepper::AdvanceHelix( const G4double yIn[],
|
||||
G4ThreeVector Bfld,
|
||||
G4double h,
|
||||
G4double yHelix[])
|
||||
G4ThreeVector Bfld,
|
||||
G4double h,
|
||||
G4double yHelix[],
|
||||
G4double yHelix2[] )
|
||||
{
|
||||
// const G4int nvar = 6;
|
||||
|
||||
//OLD const G4double approc_limit = 0.05;
|
||||
// OLD const G4double approc_limit = 0.05;
|
||||
// OLD approc_limit = 0.05 gives max.error=x^5/5!=(0.05)^5/5!=2.6*e-9
|
||||
// NEW approc_limit = 0.005 gives max.error=x^5/5!=2.6*e-14
|
||||
|
||||
const G4double approc_limit = 0.005;
|
||||
G4ThreeVector Bnorm, B_x_P, vperp, vpar;
|
||||
// G4double norm;
|
||||
G4double B_d_P; // B_perp;
|
||||
G4double Theta; // , Theta_1;
|
||||
|
||||
G4double B_d_P;
|
||||
G4double B_v_P;
|
||||
G4double Theta;
|
||||
G4double R_1;
|
||||
G4double R_Helix;
|
||||
G4double CosT2, SinT2, CosT, SinT;
|
||||
//G4double CosT, SinT;
|
||||
G4ThreeVector positionMove, endTangent;
|
||||
|
||||
G4double Bmag = Bfld.mag();
|
||||
const G4double *pIn = yIn+3;
|
||||
G4ThreeVector initVelocity= G4ThreeVector( pIn[0], pIn[1], pIn[2]);
|
||||
G4double velocityVal = initVelocity.mag();
|
||||
G4ThreeVector initTangent = (1.0/velocityVal) * initVelocity; // .unit();
|
||||
|
||||
R_1=GetInverseCurve(velocityVal,Bmag);
|
||||
G4ThreeVector initTangent = (1.0/velocityVal) * initVelocity;
|
||||
|
||||
R_1=GetInverseCurve(velocityVal,Bmag);
|
||||
|
||||
// for too small magnetic fields there is no curvature
|
||||
// (include momentum here) FIXME
|
||||
|
||||
if( (std::fabs(R_1) < 1e-10)||(Bmag<1e-12) ) {
|
||||
LinearStep( yIn, h, yHelix );
|
||||
// Store and/or calculate parameters for chord distance.
|
||||
|
||||
SetAngCurve(1.);
|
||||
SetCurve(h);
|
||||
SetRadHelix(0.);
|
||||
|
||||
} else {
|
||||
// Bnorm = Bfld.unit();
|
||||
if( (std::fabs(R_1) < 1e-10)||(Bmag<1e-12) )
|
||||
{
|
||||
LinearStep( yIn, h, yHelix );
|
||||
|
||||
// Store and/or calculate parameters for chord distance
|
||||
|
||||
SetAngCurve(1.);
|
||||
SetCurve(h);
|
||||
SetRadHelix(0.);
|
||||
}
|
||||
else
|
||||
{
|
||||
Bnorm = (1.0/Bmag)*Bfld;
|
||||
|
||||
// calculate the direction of the force
|
||||
@@ -109,59 +114,71 @@ G4MagHelicalStepper::AdvanceHelix( const G4double yIn[],
|
||||
vpar = B_d_P * Bnorm; // the component parallel to B
|
||||
vperp= initTangent - vpar; // the component perpendicular to B
|
||||
|
||||
// B_v_P = std::sqrt( 1 - B_d_P * B_d_P); // Fraction of P perp to B
|
||||
B_v_P = std::sqrt( 1 - B_d_P * B_d_P); // Fraction of P perp to B
|
||||
|
||||
// calculate the stepping angle
|
||||
|
||||
Theta = R_1 * h; // * B_v_P;
|
||||
Theta = R_1 * h; // * B_v_P;
|
||||
|
||||
// Trigonometrix
|
||||
// Trigonometrix
|
||||
|
||||
if( std::fabs(Theta) > approc_limit ) {
|
||||
SinT2 = std::sin(0.5 * Theta);
|
||||
CosT2 = std::cos(0.5 * Theta);
|
||||
// SinT = std::sin(Theta);
|
||||
// CosT = std::cos(Theta);
|
||||
SinT = 2.0 * SinT2 * CosT2;
|
||||
CosT = 1.0 - 2.0 * SinT2 * SinT2;
|
||||
} else {
|
||||
G4double Theta2 = Theta*Theta;
|
||||
G4double Theta3 = Theta2 * Theta;
|
||||
G4double Theta4 = Theta2 * Theta2;
|
||||
SinT = Theta - 1.0/6.0 * Theta3;
|
||||
CosT = 1 - 0.5 * Theta2 + 1.0/24.0 * Theta4;
|
||||
SinT2 = 0.5 * Theta - 1.0/48.0 * Theta3;
|
||||
CosT2 = 1 - 0.125 * Theta2 + 1.0/384 * Theta4;
|
||||
}
|
||||
if( std::fabs(Theta) > approc_limit )
|
||||
{
|
||||
SinT = std::sin(Theta);
|
||||
CosT = std::cos(Theta);
|
||||
}
|
||||
else
|
||||
{
|
||||
G4double Theta2 = Theta*Theta;
|
||||
G4double Theta3 = Theta2 * Theta;
|
||||
G4double Theta4 = Theta2 * Theta2;
|
||||
SinT = Theta - 1.0/6.0 * Theta3;
|
||||
CosT = 1 - 0.5 * Theta2 + 1.0/24.0 * Theta4;
|
||||
}
|
||||
|
||||
// the actual "rotation"
|
||||
// the actual "rotation"
|
||||
|
||||
G4double R = 1.0 / R_1;
|
||||
// positionMove = h * ( CosT2 * vperp + SinT2 * B_x_P + vpar );
|
||||
positionMove = R * ( SinT * vperp + (1-CosT) * B_x_P) + h * vpar;
|
||||
endTangent = (CosT * vperp + SinT * B_x_P + vpar);
|
||||
G4double R = 1.0 / R_1;
|
||||
|
||||
// Store the resulting position and tangent
|
||||
yHelix[0] = yIn[0] + positionMove.x();
|
||||
yHelix[1] = yIn[1] + positionMove.y();
|
||||
yHelix[2] = yIn[2] + positionMove.z();
|
||||
|
||||
yHelix[3] = velocityVal * endTangent.x();
|
||||
yHelix[4] = velocityVal * endTangent.y();
|
||||
yHelix[5] = velocityVal * endTangent.z();
|
||||
positionMove = R * ( SinT * vperp + (1-CosT) * B_x_P) + h * vpar;
|
||||
endTangent = CosT * vperp + SinT * B_x_P + vpar;
|
||||
|
||||
// Store and/or calculate parameters for chord distance.
|
||||
|
||||
G4ThreeVector B_x_P_x_B = B_x_P.cross(Bnorm);
|
||||
G4double ptan=B_x_P_x_B.dot(initVelocity);
|
||||
G4double particleCharge = fPtrMagEqOfMot->FCof() / (eplus*c_light);
|
||||
R_Helix =std::abs( ptan/(fUnitConstant * particleCharge*Bmag));
|
||||
// Store the resulting position and tangent
|
||||
|
||||
yHelix[0] = yIn[0] + positionMove.x();
|
||||
yHelix[1] = yIn[1] + positionMove.y();
|
||||
yHelix[2] = yIn[2] + positionMove.z();
|
||||
yHelix[3] = velocityVal * endTangent.x();
|
||||
yHelix[4] = velocityVal * endTangent.y();
|
||||
yHelix[5] = velocityVal * endTangent.z();
|
||||
|
||||
// Store 2*h step Helix if exist
|
||||
|
||||
if(yHelix2)
|
||||
{
|
||||
SinT2 = 2.0 * SinT * CosT;
|
||||
CosT2 = 1.0 - 2.0 * SinT * SinT;
|
||||
endTangent = (CosT2 * vperp + SinT2 * B_x_P + vpar);
|
||||
positionMove = R * ( SinT2 * vperp + (1-CosT2) * B_x_P) + h*2 * vpar;
|
||||
|
||||
yHelix2[0] = yIn[0] + positionMove.x();
|
||||
yHelix2[1] = yIn[1] + positionMove.y();
|
||||
yHelix2[2] = yIn[2] + positionMove.z();
|
||||
yHelix2[3] = velocityVal * endTangent.x();
|
||||
yHelix2[4] = velocityVal * endTangent.y();
|
||||
yHelix2[5] = velocityVal * endTangent.z();
|
||||
}
|
||||
|
||||
// Store and/or calculate parameters for chord distance
|
||||
|
||||
G4double ptan=velocityVal*B_v_P;
|
||||
|
||||
G4double particleCharge = fPtrMagEqOfMot->FCof() / (eplus*c_light);
|
||||
R_Helix =std::abs( ptan/(fUnitConstant * particleCharge*Bmag));
|
||||
|
||||
SetAngCurve(std::abs(Theta));
|
||||
SetCurve(std::abs(R));
|
||||
SetRadHelix(R_Helix);
|
||||
|
||||
|
||||
SetAngCurve(std::abs(Theta));
|
||||
SetCurve(std::abs(R));
|
||||
SetRadHelix(R_Helix);
|
||||
}
|
||||
}
|
||||
|
||||
@@ -172,14 +189,15 @@ G4MagHelicalStepper::AdvanceHelix( const G4double yIn[],
|
||||
|
||||
void
|
||||
G4MagHelicalStepper::Stepper( const G4double yInput[],
|
||||
const G4double*,
|
||||
G4double hstep,
|
||||
G4double yOut[],
|
||||
G4double yErr[] )
|
||||
const G4double*,
|
||||
G4double hstep,
|
||||
G4double yOut[],
|
||||
G4double yErr[] )
|
||||
{
|
||||
const G4int nvar = 6 ;
|
||||
const G4int nvar = 6;
|
||||
|
||||
G4int i;
|
||||
|
||||
// correction for Richardson Extrapolation.
|
||||
// G4double correction = 1. / ( (1 << IntegratorOrder()) -1 );
|
||||
|
||||
@@ -188,63 +206,53 @@ G4MagHelicalStepper::Stepper( const G4double yInput[],
|
||||
|
||||
// Saving yInput because yInput and yOut can be aliases for same array
|
||||
|
||||
for(i=0;i<nvar;i++) yIn[i]=yInput[i];
|
||||
for(i=0;i<nvar;i++) { yIn[i]=yInput[i]; }
|
||||
|
||||
G4double h = hstep * 0.5;
|
||||
|
||||
MagFieldEvaluate(yIn, Bfld_initial) ;
|
||||
|
||||
// Do two half steps
|
||||
|
||||
DumbStepper(yIn, Bfld_initial, h, yTemp);
|
||||
MagFieldEvaluate(yTemp, Bfld_midpoint) ;
|
||||
DumbStepper(yTemp, Bfld_midpoint, h, yOut);
|
||||
|
||||
// Store midpoint, to aid distance-from-chord calculation
|
||||
yMidPoint = G4ThreeVector( yTemp[0], yTemp[1], yTemp[2]);
|
||||
|
||||
// Do a full Step
|
||||
|
||||
h = hstep ;
|
||||
DumbStepper(yIn, Bfld_initial, h, yTemp);
|
||||
DumbStepper(yIn, Bfld_initial, h, yTemp);
|
||||
|
||||
// Error estimation
|
||||
|
||||
for(i=0;i<nvar;i++) {
|
||||
for(i=0;i<nvar;i++)
|
||||
{
|
||||
yErr[i] = yOut[i] - yTemp[i] ;
|
||||
}
|
||||
|
||||
#if G4HELICAL_USE_RICHARDSON_EXTRAPOLATION
|
||||
if( IntegratorOrder() > 1 ) {
|
||||
// It is unclear whether it is possible to
|
||||
// use the Richardson Extrapolation to increase accuracey by 1 order
|
||||
for(i=0;i<nvar;i++) {
|
||||
yOut[i] += yErr[i]*correction ;
|
||||
}
|
||||
}
|
||||
#endif
|
||||
|
||||
yInitial = G4ThreeVector( yIn[0], yIn[1], yIn[2]);
|
||||
yFinal = G4ThreeVector( yOut[0], yOut[1], yOut[2]);
|
||||
|
||||
return ;
|
||||
return;
|
||||
}
|
||||
|
||||
|
||||
G4double
|
||||
G4MagHelicalStepper::DistChord() const
|
||||
{
|
||||
// Check whether h/R > pi !!
|
||||
// Method DistLine is good only for < pi
|
||||
// Method DistLine is good only for < pi
|
||||
|
||||
G4double Ang=GetAngCurve();
|
||||
|
||||
if(Ang<pi){
|
||||
return G4LineSection::Distline( yMidPoint, yInitial, yFinal );
|
||||
// This is a class method that gives distance of Mid
|
||||
// from the Chord between the Initial and Final points.
|
||||
|
||||
if(Ang<=pi)
|
||||
{
|
||||
return GetRadHelix()*(1-std::cos(0.5*Ang));
|
||||
}
|
||||
else{
|
||||
|
||||
return GetRadHelix();
|
||||
else
|
||||
{
|
||||
if(Ang<twopi)
|
||||
{
|
||||
return GetRadHelix()*(1+std::cos(0.5*(twopi-Ang)));
|
||||
}
|
||||
else // return Diameter of projected circle
|
||||
{
|
||||
return 2*GetRadHelix();
|
||||
}
|
||||
}
|
||||
|
||||
}
|
||||
|
||||
Reference in New Issue
Block a user