48 G4int noIntegrationVariables,
51 fLastStepLength(-1.0), fAuxStepper(nullptr)
53 const G4int numberOfVariables = noIntegrationVariables;
73 const G4int numStateVars =
std::max(noIntegrationVariables, 8);
157 b43 = 1053.0/1372.0 ,
159 b51 = 3243.0/5500.0 ,
161 b53 = 50949.0/71500.0 ,
162 b54 = 4998.0/17875.0 ,
164 b61 = -26492.0/37125.0 ,
166 b63 = 2808.0/23375.0 ,
167 b64 = -24206.0/37125.0 ,
170 b71 = 5561.0/2376.0 ,
172 b73 = -24117.0/31603.0 ,
173 b74 = 899983.0/200772.0 ,
174 b75 = -5225.0/1836.0 ,
175 b76 = 3925.0/4056.0 ,
177 b81 = 465467.0/266112.0 ,
178 b82 = -2945.0/1232.0 ,
179 b83 = -5610201.0/14158144.0 ,
180 b84 = 10513573.0/3212352.0 ,
181 b85 = -424325.0/205632.0 ,
182 b86 = 376225.0/454272.0 ,
187 c3 = 98415.0/321776.0 ,
188 c4 = 16807.0/146016.0 ,
196 b93 = 98415.0/321776.0 ,
197 b94 = 16807.0/146016.0 ,
198 b95 = 1375.0/7344.0 ,
199 b96 = 1375.0/5408.0 ,
203 dc1 =
c1 - 821.0/10800.0 ,
205 dc3 = c3 - 19683.0/71825,
206 dc4 = c4 - 175273.0/912600.0 ,
207 dc5 = c5 - 395.0/3672.0 ,
208 dc6 = c6 - 785.0/2704.0 ,
209 dc7 = c7 - 3.0/50.0 ,
287 for(i=0;i<numberOfVariables;i++)
297 for(i=0;i<numberOfVariables;i++)
299 yTemp[i] =
yIn[i] + b21*Step*dydx[i] ;
303 for(i=0;i<numberOfVariables;i++)
305 yTemp[i] =
yIn[i] + Step*(b31*dydx[i] + b32*
ak2[i]) ;
309 for(i=0;i<numberOfVariables;i++)
311 yTemp[i] =
yIn[i] + Step*(b41*dydx[i] + b42*
ak2[i] + b43*
ak3[i]) ;
315 for(i=0;i<numberOfVariables;i++)
322 for(i=0;i<numberOfVariables;i++)
325 b64*
ak4[i] + b65*
ak5[i]) ;
329 for(i=0;i<numberOfVariables;i++)
336 for(i=0;i<numberOfVariables;i++)
344 for(i=0;i<numberOfVariables;i++)
346 yOut[i] =
yIn[i] + Step*(b91*dydx[i] + b92*
ak2[i] + b93*
ak3[i] +
348 b97*
ak7[i] + b98*
ak8[i] );
353 for(i=0;i<numberOfVariables;i++)
359 yErr[i] = Step*( dc1*dydx[i] + dc2*
ak2[i] + dc3*
ak3[i] + dc4*
ak4[i]
404 if (initialPoint != finalPoint)
407 distChord = distLine;
411 distChord = (midPoint-initialPoint).mag();
433 b_101 = 33797.0/460800.0 ,
436 b_104 = 27757.0/70785.0 ,
437 b_105 = 7923501.0/26329600.0 ,
438 b_106 = -927.0/3760.0 ,
439 b_107 = -3314760575.0/23165835264.0 ,
440 b_108 = 2479.0/23040.0 ,
443 for(
int i=0;i<numberOfVariables;i++)
449 for(
int i=0;i<numberOfVariables;i++)
451 yTemp[i] =
yIn[i] + Step*(b_101*dydx[i] + b_102*
ak2[i] + b_103*
ak3[i] +
452 b_104*
ak4[i] + b_105*
ak5[i] + b_106*
ak6[i] +
453 b_107*
ak7[i] + b_108*
ak8[i] + b_109*
ak9[i]);
466 bf1, bf4, bf5, bf6, bf7, bf8, bf9, bf10;
471 for(
int i=0;i<numberOfVariables;i++)
482 bf1 = (66480.0*tau_4 - 206243.0*tau_3 + 237786.0*tau_2 - 124793.0*tau + 28800.0)/28800.0 ,
483 bf4 = -16.0*tau*(45312.0*tau_3 - 125933.0*tau_2 + 119706.0*tau -40973.0)/70785.0 ,
484 bf5 = -2187.0*tau*(19440.0*tau_3 - 45743.0*tau_2 + 34786.0*tau - 9293.0)/1645600.0 ,
485 bf6 = tau*(12864.0*tau_3 - 30653.0*tau_2 + 23786.0*tau - 6533.0)/705.0 ,
486 bf7 = -5764801.0*tau*(16464.0*tau_3 - 32797.0*tau_2 + 17574.0*tau - 1927.0)/7239323520.0 ,
487 bf8 = 37.0*tau*(336.0*tau_3 - 661.0*tau_2 + 342.0*tau -31.0)/1440.0 ,
488 bf9 = tau*(tau-1.0)*(16.0*tau_2 - 15.0*tau +3.0)/4.0 ,
489 bf10 = 8.0*tau*(tau - 1.0)*(tau - 1.0)*(2.0*tau - 1.0) ;
491 for(
int i=0; i<numberOfVariables; i++){
492 yOut[i] =
yIn[i] + Step*tau*( bf1*dydx[i] + bf4*
ak4[i] + bf5*
ak5[i] +
524 b101 = 33797.0/460800.0 ,
527 b104 = 27757.0/70785.0 ,
528 b105 = 7923501.0/26329600.0 ,
529 b106 = -927.0/3760.0 ,
530 b107 = -3314760575.0/23165835264.0 ,
531 b108 = 2479.0/23040.0 ,
534 b111 = 5843.0/76800.0 ,
537 b114 = 464.0/2673.0 ,
538 b115 = 353997.0/1196800.0 ,
539 b116 = -15068.0/57105.0 ,
540 b117 = -282475249.0/3644974080.0 ,
541 b118 = 8678831.0/156245760.0 ,
542 b119 = 116113.0/11718432.0 ,
543 b1110 = -25.0/243.0 ,
545 b121 = 15088049.0/199065600.0 ,
549 b125 = 92222037.0/268083200.0 ,
550 b126 = -433420501.0/1528586640.0 ,
551 b127 = -11549242677007.0/83630285291520.0 ,
552 b128 = 2725085557.0/26167173120.0 ,
553 b129 = 235429367.0/16354483200.0 ,
554 b1210 = -90924917.0/1040739840.0 ,
555 b1211 = -271149.0/21414400.0 ;
561 for(
int i=0;i<numberOfVariables;i++)
572 for(
int i=0;i<numberOfVariables;i++)
574 yTemp[i] =
yIn[i] + Step*(b101*dydx[i] + b102*
ak2[i] + b103*
ak3[i] +
575 b104*
ak4[i] + b105*
ak5[i] + b106*
ak6[i] +
576 b107*
ak7[i] + b108*
ak8[i] + b109*
ak9[i]);
580 for(
int i=0;i<numberOfVariables;i++)
582 yTemp[i] =
yIn[i] + Step*(b111*dydx[i] + b112*
ak2[i] + b113*
ak3[i] +
583 b114*
ak4[i] + b115*
ak5[i] + b116*
ak6[i] +
584 b117*
ak7[i] + b118*
ak8[i] + b119*
ak9[i] +
589 for(
int i=0;i<numberOfVariables;i++)
591 yTemp[i] =
yIn[i] + Step*(b121*dydx[i] + b122*
ak2[i] + b123*
ak3[i] +
592 b124*
ak4[i] + b125*
ak5[i] + b126*
ak6[i] +
593 b127*
ak7[i] + b128*
ak8[i] + b129*
ak9[i] +
617 bi[1][1] = -18487.0/2880.0 ,
618 bi[1][2] = 139189.0/7200.0 ,
619 bi[1][3] = -53923.0/1800.0 ,
620 bi[1][4] = 13811.0/600,
621 bi[1][5] = -2071.0/300,
644 bi[4][1] = -30208.0/14157.0 ,
645 bi[4][2] = 1147904.0/70785.0 ,
646 bi[4][3] = -241664.0/5445.0 ,
647 bi[4][4] = 241664.0/4719.0 ,
648 bi[4][5] = -483328.0/23595.0 ,
653 bi[5][1] = -177147.0/32912.0 ,
654 bi[5][2] = 3365793.0/82280.0 ,
655 bi[5][3] = -2302911.0/20570.0 ,
656 bi[5][4] = 531441.0/4114.0 ,
657 bi[5][5] = -531441.0/10285.0 ,
662 bi[6][1] = 536.0/141.0 ,
663 bi[6][2] = -20368.0/705.0 ,
664 bi[6][3] = 55744.0/705.0 ,
665 bi[6][4] = -4288.0/47.0 ,
666 bi[6][5] = 8576.0/235,
671 bi[7][1] = -1977326743.0/723932352.0 ,
672 bi[7][2] = 37569208117.0/1809830880.0 ,
673 bi[7][3] = -1977326743.0/34804440.0 ,
674 bi[7][4] = 1977326743.0/30163848.0 ,
675 bi[7][5] = -1977326743.0/75409620.0 ,
680 bi[8][1] = 259.0/144.0 ,
681 bi[8][2] = -4921.0/360.0 ,
682 bi[8][3] = 3367.0/90.0 ,
683 bi[8][4] = -259.0/6.0 ,
684 bi[8][5] = 259.0/15.0 ,
689 bi[9][1] = 62.0/105.0 ,
690 bi[9][2] = -2381.0/525.0 ,
691 bi[9][3] = 949.0/75.0 ,
692 bi[9][4] = -2636.0/175.0 ,
693 bi[9][5] = 1112.0/175.0 ,
698 bi[10][1] = 43.0/3.0 ,
699 bi[10][2] = -1534.0/15.0 ,
700 bi[10][3] = 3767.0/15.0 ,
701 bi[10][4] = -1264.0/5.0 ,
702 bi[10][5] = 448.0/5.0 ,
707 bi[11][1] = 63.0/5.0 ,
708 bi[11][2] = -1494.0/25.0 ,
709 bi[11][3] = 2907.0/25.0 ,
710 bi[11][4] = -2592.0/25.0 ,
711 bi[11][5] = 864.0/25.0 ,
716 bi[12][1] = -576.0/35.0 ,
717 bi[12][2] = 19584.0/175.0 ,
718 bi[12][3] = -6336.0/25.0 ,
719 bi[12][4] = 41472.0/175.0 ,
720 bi[12][5] = -13824.0/175.0 ;
724 for(
G4int i = 0; i< numberOfVariables; i++)
730 for(
int i=1; i<=12; i++){
733 for(
int j=0; j<=5; j++){
734 b[i] += bi[i][j]*tau;
742 for(
int i=0; i<numberOfVariables; i++){
743 yOut[i] =
yIn[i] + Step*tau0*(b[1]*dydx[i] + b[2]*
ak2[i] + b[3]*
ak3[i] +
744 b[4]*
ak4[i] + b[5]*
ak5[i] + b[6]*
ak6[i] +
745 b[7]*
ak7[i] + b[8]*
ak8[i] + b[9]*
ak9[i] +
G4DormandPrinceRK56(G4EquationOfMotion *EqRhs, G4int numberOfVariables=6, G4bool primary=true)
void SetupInterpolate_high(const G4double yInput[], const G4double dydx[], const G4double Step)
T max(const T t1, const T t2)
brief Return the largest of the two arguments
CLHEP::Hep3Vector G4ThreeVector
static G4double Distline(const G4ThreeVector &OtherPnt, const G4ThreeVector &LinePntA, const G4ThreeVector &LinePntB)
void Interpolate_low(const G4double yInput[], const G4double dydx[], const G4double Step, G4double yOut[], G4double tau)
G4double * fLastInitialVector
void RightHandSide(const double y[], double dydx[]) const
void Interpolate_high(const G4double yInput[], const G4double dydx[], const G4double Step, G4double yOut[], G4double tau)
void Stepper(const G4double y[], const G4double dydx[], G4double h, G4double yout[], G4double yerr[])
void SetupInterpolate_low(const G4double yInput[], const G4double dydx[], const G4double Step)
G4int GetNumberOfVariables() const
G4double * fLastFinalVector
G4double DistChord() const
G4DormandPrinceRK56 * fAuxStepper