// This code implementation is the intellectual property of
// the GEANT4 collaboration.
//
// By copying, distributing or modifying the Program (or any work
// based on the Program) you indicate your acceptance of this statement,
// and all its terms.
//
// $Id: G4MagIntegratorStepper.icc,v 1.3 1999/12/15 14:49:47 gunter Exp $
// GEANT4 tag $Name: geant4-01-01 $
//
inline G4EquationOfMotion* G4MagIntegratorStepper::GetEquationOfMotion() const
 { return  fEquation_Rhs; } 

inline void G4MagIntegratorStepper::RightHandSide( const  double y[], double dydx[] )   
	{  fEquation_Rhs-> RightHandSide(y, dydx); }

inline G4int   G4MagIntegratorStepper::GetNumberOfVariables()
 { return fNumberOfVariables; } 
inline void  G4MagIntegratorStepper::SetNumberOfVariables(G4int newNo)
 { fNumberOfVariables = newNo; } 


inline void G4MagIntegratorStepper::
NormaliseTangentVector( G4double vec[6] )
{
   double drds2 = vec[3]*vec[3]+vec[4]*vec[4]+vec[5]*vec[5];

   if( fabs(drds2 - 1.0) > 1.e-14 ){
      double normx = 1.0 / sqrt(drds2);
      for(int i=0;i<3;i++) 
	 vec[i+3] *= normx;   
   }
}