Trk::KalmanVertexOnJetAxisSmoother Class Reference

ATLAS Reconstruction Software - (C) 2005 - 2007. More...

#include <KalmanVertexOnJetAxisSmoother.h>

Inheritance diagram for Trk::KalmanVertexOnJetAxisSmoother:

Collaboration diagram for Trk::KalmanVertexOnJetAxisSmoother:

Public Member Functions
virtual StatusCode	initialize () override
	KalmanVertexOnJetAxisSmoother (const std::string &t, const std::string &n, const IInterface *p)
	Constructor.
	~KalmanVertexOnJetAxisSmoother ()
	Destructor.
void	update (VxVertexOnJetAxis *vertexToSmooth, const VxJetCandidate *candidateToUpdate, bool updateTrack=true) const
	Update the VxVertexOnJetAxis (chi2 and ndf) with the knowledge coming from the fitted VxJetCandidate, updating (or not) also all the related track parameters of the tracks at the vertex (smoothing).
void	fastUpdate (VxVertexOnJetAxis *vertexToSmooth, const VxJetCandidate *candidateToUpdate, bool updateTrack=true) const
void	update (VxVertexOnJetAxis *vertexToSmooth, bool isPrimary, const RecVertexPositions &myFinalPosition, const VertexPositions &linearizationPositions, bool updateTrack=false, bool doFastUpdate=false) const
	Update the VxVertexOnJetAxis (chi2 and ndf) with the knowledge coming from the fitted RecVertexPositions, taking into account the linearization positions, updating (or not) all the related track parameters of the tracks at the vertex (smoothing).
ServiceHandle< StoreGateSvc > &	evtStore ()
	The standard StoreGateSvc (event store) Returns (kind of) a pointer to the StoreGateSvc.
const ServiceHandle< StoreGateSvc > &	detStore () const
	The standard StoreGateSvc/DetectorStore Returns (kind of) a pointer to the StoreGateSvc.
virtual StatusCode	sysInitialize () override
	Perform system initialization for an algorithm.
virtual StatusCode	sysStart () override
	Handle START transition.
virtual std::vector< Gaudi::DataHandle * >	inputHandles () const override
	Return this algorithm's input handles.
virtual std::vector< Gaudi::DataHandle * >	outputHandles () const override
	Return this algorithm's output handles.
Gaudi::Details::PropertyBase &	declareProperty (Gaudi::Property< T, V, H > &t)
void	updateVHKA (Gaudi::Details::PropertyBase &)
MsgStream &	msg () const
bool	msgLvl (const MSG::Level lvl) const

Static Public Member Functions
static const InterfaceID &	interfaceID ()

Protected Member Functions
void	renounceArray (SG::VarHandleKeyArray &handlesArray)
	remove all handles from I/O resolution
std::enable_if_t< std::is_void_v< std::result_of_t< decltype(&T::renounce)(T)> > &&!std::is_base_of_v< SG::VarHandleKeyArray, T > &&std::is_base_of_v< Gaudi::DataHandle, T >, void >	renounce (T &h)
void	extraDeps_update_handler (Gaudi::Details::PropertyBase &ExtraDeps)
	Add StoreName to extra input/output deps as needed.

Private Types
typedef ServiceHandle< StoreGateSvc >	StoreGateSvc_t

Private Member Functions
	AmgSymMatrix (3) m_initial_cov_momentum
Gaudi::Details::PropertyBase &	declareGaudiProperty (Gaudi::Property< T, V, H > &hndl, const SG::VarHandleKeyType &)
	specialization for handling Gaudi::Property<SG::VarHandleKey>

Private Attributes
ToolHandle< KalmanVertexOnJetAxisUpdator >	m_Updator
double	m_maxWeight
	Meaningless in case no adaptive fitting is used.
double	m_initialMomentumError
StoreGateSvc_t	m_evtStore
	Pointer to StoreGate (event store by default)
StoreGateSvc_t	m_detStore
	Pointer to StoreGate (detector store by default)
std::vector< SG::VarHandleKeyArray * >	m_vhka
bool	m_varHandleArraysDeclared

Detailed Description

ATLAS Reconstruction Software - (C) 2005 - 2007.

Author

Giacinto Piacquadio, (giaci.nosp@m.nto..nosp@m.piacq.nosp@m.uadi.nosp@m.o@phy.nosp@m.sik..nosp@m.uni-f.nosp@m.reib.nosp@m.urg.d.nosp@m.e)

Christian Weiser, (chris.nosp@m.tian.nosp@m..weis.nosp@m.er@p.nosp@m.hysik.nosp@m..uni.nosp@m.-frei.nosp@m.burg.nosp@m..de)

A concrete implementation of the Vertex Smoother for smoothing the vertexing along the Jet Axis.

This is a special implementation (part of the JetFitter(TM) algorithm) which is able to smooth a vertex correcting the jet axis parameters to find the best overall agreement.

Basic approach is based on R. Fruhwirth et al. Comp. Phys. Comm 96(1996) 189

First version: December 2006 Updated version for athena: Februar 2007

Alberts-Ludwig-Universita"t Freiburg

Definition at line 48 of file KalmanVertexOnJetAxisSmoother.h.

Member Typedef Documentation

StoreGateSvc_t

typedef ServiceHandle<StoreGateSvc> AthCommonDataStore< AthCommonMsg< AlgTool > >::StoreGateSvc_t

privateinherited

Definition at line 388 of file AthCommonDataStore.h.

Constructor & Destructor Documentation

KalmanVertexOnJetAxisSmoother()

Trk::KalmanVertexOnJetAxisSmoother::KalmanVertexOnJetAxisSmoother	(	const std::string &	t,
		const std::string &	n,
		const IInterface *	p )

Constructor.

Definition at line 48 of file KalmanVertexOnJetAxisSmoother.cxx.

                                                                                                                         :
   AthAlgTool(t,n,p),
   m_Updator("Trk::KalmanVertexOnJetAxisUpdator", this),
   m_maxWeight(0.001),
   m_initialMomentumError(1000.)
 { 
   declareProperty("Updator",m_Updator);
   declareProperty("MaximalWeight",m_maxWeight);
   declareProperty("initialMomentumError",m_initialMomentumError);
   declareInterface<KalmanVertexOnJetAxisSmoother>(this);
 }

~KalmanVertexOnJetAxisSmoother()

Trk::KalmanVertexOnJetAxisSmoother::~KalmanVertexOnJetAxisSmoother ( )

default

Destructor.

Member Function Documentation

AmgSymMatrix()

Trk::KalmanVertexOnJetAxisSmoother::AmgSymMatrix ( 3 )

private

declareGaudiProperty()

Gaudi::Details::PropertyBase & AthCommonDataStore< AthCommonMsg< AlgTool > >::declareGaudiProperty ( Gaudi::Property< T, V, H > & hndl, const SG::VarHandleKeyType &  )

inlineprivateinherited

specialization for handling Gaudi::Property<SG::VarHandleKey>

Definition at line 156 of file AthCommonDataStore.h.

  {
    return *AthCommonDataStore<PBASE>::declareProperty(hndl.name(),
                                                       hndl.value(), 
                                                       hndl.documentation());
 
  }

declareProperty()

Gaudi::Details::PropertyBase & AthCommonDataStore< AthCommonMsg< AlgTool > >::declareProperty ( Gaudi::Property< T, V, H > & t )

inlineinherited

Definition at line 145 of file AthCommonDataStore.h.

                                                                     {
    typedef typename SG::HandleClassifier<T>::type htype;
    return AthCommonDataStore<PBASE>::declareGaudiProperty(t, htype());
  }

detStore()

const ServiceHandle< StoreGateSvc > & AthCommonDataStore< AthCommonMsg< AlgTool > >::detStore ( ) const

inlineinherited

The standard StoreGateSvc/DetectorStore Returns (kind of) a pointer to the StoreGateSvc.

Definition at line 95 of file AthCommonDataStore.h.

{ return m_detStore; }

evtStore()

ServiceHandle< StoreGateSvc > & AthCommonDataStore< AthCommonMsg< AlgTool > >::evtStore ( )

inlineinherited

The standard StoreGateSvc (event store) Returns (kind of) a pointer to the StoreGateSvc.

Definition at line 85 of file AthCommonDataStore.h.

{ return m_evtStore; }

extraDeps_update_handler()

void AthCommonDataStore< AthCommonMsg< AlgTool > >::extraDeps_update_handler ( Gaudi::Details::PropertyBase & ExtraDeps )

protectedinherited

Add StoreName to extra input/output deps as needed.

use the logic of the VarHandleKey to parse the DataObjID keys supplied via the ExtraInputs and ExtraOuputs Properties to add the StoreName if it's not explicitly given

fastUpdate()

void Trk::KalmanVertexOnJetAxisSmoother::fastUpdate	(	VxVertexOnJetAxis *	vertexToSmooth,
		const VxJetCandidate *	candidateToUpdate,
		bool	updateTrack = true ) const

Definition at line 75 of file KalmanVertexOnJetAxisSmoother.cxx.

                                                                         {
    const RecVertexPositions & myFinalPosition=candidateToUpdate->getRecVertexPositions();
    const VertexPositions & linearizationPositions=candidateToUpdate->getLinearizationVertexPositions();
    bool isPrimary = (vertexToSmooth==candidateToUpdate->getPrimaryVertex());
    update(vertexToSmooth,isPrimary,myFinalPosition,linearizationPositions,updateTrack,true);
  }

initialize()

StatusCode Trk::KalmanVertexOnJetAxisSmoother::initialize ( )

overridevirtual

Definition at line 29 of file KalmanVertexOnJetAxisSmoother.cxx.

 {
  AthAlgTool::initialize().ignore();
 
  //retrieving the udator itself     
  StatusCode sc = m_Updator.retrieve();
  if(sc.isFailure())    {      
    ATH_MSG_ERROR( " Unable to retrieve "<<m_Updator );
    return StatusCode::FAILURE;      
  }
  m_initial_cov_momentum.setZero();
  m_initial_cov_momentum(0,0) = m_initialMomentumError*m_initialMomentumError;
  m_initial_cov_momentum(1,1) = m_initialMomentumError*m_initialMomentumError;
  m_initial_cov_momentum(2,2) = m_initialMomentumError*m_initialMomentumError/10000.;
 
  return StatusCode::SUCCESS;
 }

inputHandles()

virtual std::vector< Gaudi::DataHandle * > AthCommonDataStore< AthCommonMsg< AlgTool > >::inputHandles ( ) const

overridevirtualinherited

Return this algorithm's input handles.

We override this to include handle instances from key arrays if they have not yet been declared. See comments on updateVHKA.

interfaceID()

const InterfaceID & Trk::KalmanVertexOnJetAxisSmoother::interfaceID ( )

inlinestatic

Definition at line 66 of file KalmanVertexOnJetAxisSmoother.h.

     {
       return IID_KalmanVertexOnJetAxisSmoother;
     };

msg()

MsgStream & AthCommonMsg< AlgTool >::msg ( ) const

inlineinherited

Definition at line 24 of file AthCommonMsg.h.

                                {
    return this->msgStream();
  }

msgLvl()

bool AthCommonMsg< AlgTool >::msgLvl ( const MSG::Level lvl ) const

inlineinherited

Definition at line 30 of file AthCommonMsg.h.

                                               {
    return this->msgLevel(lvl);
  }

outputHandles()

virtual std::vector< Gaudi::DataHandle * > AthCommonDataStore< AthCommonMsg< AlgTool > >::outputHandles ( ) const

overridevirtualinherited

Return this algorithm's output handles.

We override this to include handle instances from key arrays if they have not yet been declared. See comments on updateVHKA.

renounce()

std::enable_if_t< std::is_void_v< std::result_of_t< decltype(&T::renounce)(T)> > &&!std::is_base_of_v< SG::VarHandleKeyArray, T > &&std::is_base_of_v< Gaudi::DataHandle, T >, void > AthCommonDataStore< AthCommonMsg< AlgTool > >::renounce ( T & h )

inlineprotectedinherited

Definition at line 380 of file AthCommonDataStore.h.

  {
    h.renounce();
    PBASE::renounce (h);
  }

renounceArray()

void AthCommonDataStore< AthCommonMsg< AlgTool > >::renounceArray ( SG::VarHandleKeyArray & handlesArray )

inlineprotectedinherited

remove all handles from I/O resolution

Definition at line 364 of file AthCommonDataStore.h.

                                                          {
    handlesArray.renounce();
  }

sysInitialize()

virtual StatusCode AthCommonDataStore< AthCommonMsg< AlgTool > >::sysInitialize ( )

overridevirtualinherited

Perform system initialization for an algorithm.

We override this to declare all the elements of handle key arrays at the end of initialization. See comments on updateVHKA.

Reimplemented in asg::AsgMetadataTool, AthCheckedComponent< AthAlgTool >, AthCheckedComponent<::AthAlgTool >, and DerivationFramework::CfAthAlgTool.

sysStart()

virtual StatusCode AthCommonDataStore< AthCommonMsg< AlgTool > >::sysStart ( )

overridevirtualinherited

Handle START transition.

We override this in order to make sure that conditions handle keys can cache a pointer to the conditions container.

update() [1/2]

void Trk::KalmanVertexOnJetAxisSmoother::update	(	VxVertexOnJetAxis *	vertexToSmooth,
		bool	isPrimary,
		const RecVertexPositions &	myFinalPosition,
		const VertexPositions &	linearizationPositions,
		bool	updateTrack = false,
		bool	doFastUpdate = false ) const

Update the VxVertexOnJetAxis (chi2 and ndf) with the knowledge coming from the fitted RecVertexPositions, taking into account the linearization positions, updating (or not) all the related track parameters of the tracks at the vertex (smoothing).

Definition at line 84 of file KalmanVertexOnJetAxisSmoother.cxx.

                                                                   {
 
 //  void KalmanVertexOnJetAxisSmoother::update(VxVertexOnJetAxis* vertexToSmooth,const VxJetCandidate* candidateToUpdate) const
   //  {
 
    if (vertexToSmooth==nullptr) {
      ATH_MSG_WARNING( " Empty pointers then calling fit method update. No fit will be done..." );
      return;
    }
 
    ATH_MSG_DEBUG("It's smoothing "<<(isPrimary? "with":"without")<<" primary vertex ");
    ATH_MSG_DEBUG("It's " << (updateTrack?"with":"without") << " updating the track.");
    ATH_MSG_DEBUG("It's the "<<(doFastUpdate?"fast":"normal (weight-formalism)")<<" smoother");
 
    const std::vector<VxTrackAtVertex*> & allTracksToSmooth(vertexToSmooth->getTracksAtVertex());
 
    //care first about the transformation matrix (which is the same for all tracks...)
    
    
    if (allTracksToSmooth.empty()) {
      ATH_MSG_DEBUG(" Nothing to smooth ");
      if (!isPrimary)
    ATH_MSG_WARNING ("Nothing to smooth and it's not a primary vertex: BUG... ");
      return;
    }
 
    const Amg::VectorX & initialjetdir=linearizationPositions.position();
 
    int numVertex=vertexToSmooth->getNumVertex();
 
    
    //calculate 3-dim position on jet axis from linearizationPositionVector and calculate Jacobian of transformation
    std::pair<Amg::Vector3D,Eigen::Matrix3Xd> PosOnJetAxisAndTransformMatrix = 
      m_Updator->createTransformJacobian(initialjetdir, numVertex, isPrimary, /*truncate=*/false);
 
    #ifdef KalmanVertexOnJetAxisSmoother_DEBUG
    std::cout << " smoother: " << PosOnJetAxisAndTransformMatrix.first << " and transform matrix: " << PosOnJetAxisAndTransformMatrix.second << 
      std::endl;
    #endif
 
 
    //prepare a RecVertexPositions to be updated with removal 
    //of all tracks of the present vertex...
    //THIS TIME copy the RecVertexPositions to a new object... :-)
    RecVertexPositions myPositionWithRemovedTracks=myFinalPosition; // for fast updator (cov formalism)
    RecVertexPositions myPositionInWeightFormalism=myFinalPosition; // for full updator (weight formalism)
    const Amg::VectorX & final_vrt_pos=myFinalPosition.position();
    const Amg::MatrixX & final_vrt_covariance = myFinalPosition.covariancePosition();
 
    Amg::MatrixX         final_vrt_weightmatrix;
    if (!doFastUpdate) {
      // Hack the JetFitter EDM... avoid to invert big cov matrix at each iteration
      // by storing position --> weight*position
      // and        covariance -> weightmatrix
      Eigen::FullPivLU<Amg::MatrixX> lu_decomp(final_vrt_covariance);
      if (!lu_decomp.isInvertible()) {
        ATH_MSG_DEBUG("Jet vertex positions matrix not invertible right at start of smoother!" <<
                      " -> stop smoothing.");
        return;
      }
      final_vrt_weightmatrix = final_vrt_covariance.inverse();
      myPositionInWeightFormalism.setPosition(final_vrt_weightmatrix*
                                              myPositionInWeightFormalism.position());
      myPositionInWeightFormalism.setCovariancePosition(final_vrt_weightmatrix);
    }
    //from here onwards (until finishing adding tracks) it is weight*position TO MAKE THINGS FASTER 
 
    double track_compatibility_chi2(0.);
    double track_ndf(0.);
 
    //nice! that was easy...
    //now iterate over all tracks in order to calculated the updated TrackParameters + the residual chi2...
    const std::vector<VxTrackAtVertex*>::const_iterator TracksBegin=allTracksToSmooth.begin();
    const std::vector<VxTrackAtVertex*>::const_iterator TracksEnd=allTracksToSmooth.end();
 
    for (std::vector<VxTrackAtVertex*>::const_iterator TracksIter=TracksBegin;TracksIter!=TracksEnd;++TracksIter) {
      
      //get linearized track
      const LinearizedTrack * trk=(*TracksIter)->linState();
      
      if (trk==nullptr) {
        ATH_MSG_WARNING (" Empty pointers then calling smoothing method update. No smoothing will be performed...");
        return;
      }
      
      double trackWeight = (*TracksIter)->weight();
 
      //only position jacobian changed from A ->oldA
      const AmgMatrix(5,3)& oldA = trk->positionJacobian();
      
      #ifdef KalmanVertexOnJetAxisSmoother_DEBUG
      std::cout << "the old jacobian xyz d0z0phithetaqoverp vs xyz " << oldA << std::endl; 
      #endif
      
      //now create the new jacobian which you should use
      Eigen::Matrix<double,5,Eigen::Dynamic> A = oldA*PosOnJetAxisAndTransformMatrix.second;
    
      #ifdef KalmanVertexOnJetAxisSmoother_DEBUG
      std::cout << "the new jacobian " << A << std::endl;
      #endif
      
      const AmgMatrix(5,3) & B = trk->momentumJacobian();
      const AmgVector(5)& trackParameters = trk->expectedParametersAtPCA();
 
      #ifdef KalmanVertexOnJetAxisSmoother_DEBUG
      std::cout << "expected perigee at pca " << trackParameters << std::endl;
      std::cout << "expected position at pca " << trk->expectedPositionAtPCA() << std::endl;
      std::cout << " constant term " << trk->constantTerm() << 
    " old A " << oldA << " * PosOnJetAxis " << PosOnJetAxisAndTransformMatrix.first << 
    " A " << A << " * initialjetdir " << initialjetdir << std::endl;
      #endif
 
      AmgVector(5) constantTerm=trk->constantTerm() + oldA*PosOnJetAxisAndTransformMatrix.first
    -A*initialjetdir;
      const AmgSymMatrix(5)& trackParametersWeight  = trk->expectedWeightAtPCA();
      AmgSymMatrix(3) S = B.transpose()*trackParametersWeight*B;
      if(S.determinant()==0.0) {
        ATH_MSG_WARNING ("The S matrix inversion failed during smoothing iteration cycle");
        continue;
      }
      S=S.inverse().eval();
      
      if (doFastUpdate) {
        const Amg::VectorX old_vrt_pos   = myPositionWithRemovedTracks.position();
        const Amg::MatrixX & old_vrt_cov = myPositionWithRemovedTracks.covariancePosition();
 
        AmgSymMatrix(5) old_residual_cov = -trk->expectedCovarianceAtPCA() + 
            A*old_vrt_cov*A.transpose() + B*m_initial_cov_momentum*B.transpose();
        if (old_residual_cov.determinant() == 0.0 ) {
          ATH_MSG_ERROR ("The old_residual matrix can not be inverted during smoothing interation cycle");
          continue;
        }
        AmgSymMatrix(5) old_residual_cov_inv = old_residual_cov.inverse().eval();
        Eigen::Matrix<double,Eigen::Dynamic,5> Kk1=old_vrt_cov*A.transpose()*old_residual_cov_inv;
        AmgVector(5) residual_vector=trackParameters-constantTerm-A*old_vrt_pos;
        Amg::VectorX new_vrt_pos = old_vrt_pos+Kk1*residual_vector;
        Amg::MatrixX new_vrt_cov = old_vrt_cov+Kk1*old_residual_cov*Kk1.transpose()
                                   - 2.*Kk1*A*old_vrt_cov;
        myPositionWithRemovedTracks = RecVertexPositions(new_vrt_pos,new_vrt_cov);
 
      } else {
 
        //REMEMBER: there's also the RecVertexPositions w/ removed tracks: **myPositionWithRemovedTracks**
 
        #ifdef KalmanVertexOnJetAxisSmoother_DEBUG
    std::cout << " Old weight Matrix is " << myPositionInWeightFormalism.covariancePosition() << std::endl;
        #endif
 
        // the full smoother writes weight matrices into RecVertexPositions
        const Amg::MatrixX & old_vrt_weight = myPositionInWeightFormalism.covariancePosition();
        const Amg::VectorX old_vrt_weight_times_vrt_pos = myPositionInWeightFormalism.position();
      
        //G_b = G_k - G_k*B_k*W_k*B_k^(T)*G_k  
        AmgSymMatrix(5) gB = trackParametersWeight - trackParametersWeight*(B*(S*B.transpose()))*trackParametersWeight.transpose();
        //(S.similarity(B)).similarity(trackParametersWeight);
      
        #ifdef KalmanVertexOnJetAxisSmoother_DEBUG
    std::cout<<"Gain factor obtained: "<<trackParametersWeight*(B*(S*B.transpose()))*trackParametersWeight.transpose()<<std::endl;
    std::cout<<"Resulting Gain Matrix: "<<gB<<std::endl;
        #endif
      
        //new vertex weight matrix  
        Amg::MatrixX new_vrt_weight = old_vrt_weight - trackWeight * A.transpose()*gB*A;
      
        #ifdef KalmanVertexOnJetAxisSmoother_DEBUG
    std::cout<<"New vertex weight obtained: "<<new_vrt_weight<<std::endl;
        #endif
      
        //new vertex position
        Amg::VectorX new_weight_matrix_times_vrt_position =old_vrt_weight_times_vrt_pos - trackWeight * A.transpose() * gB *(trackParameters - constantTerm);
        //  new_vrt_cov*(old_vrt_weight * old_vrt_pos + trackWeight * sign * A.T() * gB *(trackParameters - constantTerm) ); 
        // avoid to invert the weight matrix to obtain the COVARIANCE MATRIX!!!
        //this line COPIES things two times, it would be nice to have a operator=(pos,errm) method in RecVertexPositions...    
        myPositionInWeightFormalism = 
          RecVertexPositions(new_weight_matrix_times_vrt_position,new_vrt_weight);
      } 
 
      //refitted track momentum  
      Amg::Vector3D newTrackMomentum = S*B.transpose()*trackParametersWeight*(trackParameters - constantTerm - A*final_vrt_pos);
      //refitted track parameters
      AmgVector(5) refTrackParameters = constantTerm + A * final_vrt_pos + B * newTrackMomentum;
 
      if (updateTrack) {
 
    const AmgSymMatrix(3) final_vrt_covariance_xyz = 
            (PosOnJetAxisAndTransformMatrix.second)*final_vrt_covariance*(PosOnJetAxisAndTransformMatrix.second).transpose();
    
    AmgVector(5) refTrackParametersToStore(refTrackParameters);
 
 
    //bring parameter phi again in the limits, if 
    //phi is slightly outside (as can be expected 
    //due to refitting)
    //thanks to Wolfgang L. / Sebastian F. for the piece of code with fmod!
    //  bool isSth=false;
    if (refTrackParametersToStore[Trk::phi0] > M_PI)  {
      //      isSth=true;
      ATH_MSG_DEBUG ("-U- phi = " << refTrackParametersToStore[Trk::phi0]);
      refTrackParametersToStore[Trk::phi0] = fmod(refTrackParametersToStore[Trk::phi0]+M_PI,2*M_PI)-M_PI;
      ATH_MSG_DEBUG (" out of range, now corrected to " << refTrackParametersToStore[Trk::phi0]);
    } else if(refTrackParametersToStore[Trk::phi0]<-M_PI) {
      ATH_MSG_DEBUG ("-U- phi = " << refTrackParametersToStore[Trk::phi0]);
      refTrackParametersToStore[Trk::phi0] = fmod(refTrackParametersToStore[Trk::phi0]-M_PI,2*M_PI)+M_PI;
      ATH_MSG_DEBUG (" out of range, now corrected to " << refTrackParametersToStore[Trk::phi0]);
    }
 
    if (refTrackParametersToStore[Trk::theta] > M_PI)
    {
      ATH_MSG_DEBUG (" Theta out of range: correcting theta: " << refTrackParametersToStore[Trk::theta]);
      refTrackParametersToStore[Trk::theta]=fmod(refTrackParametersToStore[Trk::theta]+M_PI,2*M_PI)-M_PI;
      ATH_MSG_DEBUG (" to: " << refTrackParametersToStore[Trk::theta]);
    }
    else if (refTrackParametersToStore[Trk::theta]<0) {
      ATH_MSG_DEBUG (" Theta out of range: correcting theta: " << refTrackParametersToStore[Trk::theta]);
      refTrackParametersToStore[Trk::theta]=fmod(refTrackParametersToStore[Trk::theta]-M_PI,2*M_PI)+M_PI;
      ATH_MSG_DEBUG (" to: " << refTrackParametersToStore[Trk::theta]);
    }     
 
    if (refTrackParametersToStore[Trk::theta] < 0) {
      refTrackParametersToStore[Trk::theta] =
        - refTrackParametersToStore[Trk::theta];
      refTrackParametersToStore[Trk::phi0] +=
        (refTrackParametersToStore[Trk::phi0] > 0 ? -M_PI : M_PI);
    }
    else if (refTrackParametersToStore[Trk::theta] > M_PI) {//this is in principle not needed anymore
      refTrackParametersToStore[Trk::theta] =
        2*M_PI - refTrackParametersToStore[Trk::theta];
      refTrackParametersToStore[Trk::phi0] +=
        (refTrackParametersToStore[Trk::phi0] > 0 ? -M_PI : M_PI);
    }
 
    //making a new track covariance matrix
    AmgMatrix(Eigen::Dynamic,3) partialCovariance     = A.transpose() * trackParametersWeight * B *S;
 
    AmgMatrix(Eigen::Dynamic,3) posMomentumCovariance =  -final_vrt_covariance * partialCovariance;
 
    AmgMatrix(Eigen::Dynamic,3) posMomentumCovariance_xyz = PosOnJetAxisAndTransformMatrix.second * posMomentumCovariance;
    
    //new momentum covariance 
    AmgSymMatrix(3) momentumCovariance = doFastUpdate ?
            S + (partialCovariance.transpose()*final_vrt_covariance*partialCovariance) :
            S + (posMomentumCovariance.transpose()*final_vrt_weightmatrix*posMomentumCovariance);
    
    //full (x,y,z,phi, theta, q/p) covariance matrix
    AmgSymMatrix(6) fullTrkCov; fullTrkCov.setZero();
 
        #ifdef KalmanVertexOnJetAxisSmoother_DEBUG
    std::cout << " posMomentumCovariance " << posMomentumCovariance << 
      " final_vrt_covariance " << final_vrt_covariance << " momentumCovariance " << 
      momentumCovariance << std::endl;
        #endif
 
    fullTrkCov.block<3,3>(0,3) = posMomentumCovariance_xyz.transpose();//GP: to be checked: .T() is here or down?
    fullTrkCov.block<3,3>(3,0) = posMomentumCovariance_xyz;
    fullTrkCov.block<3,3>(0,0) = final_vrt_covariance_xyz; 
    fullTrkCov.block<3,3>(3,3) = momentumCovariance; 
    //debug hacking   
    AmgMatrix(5,6) trJac; trJac.setZero();
    trJac(4,5) = 1.;
    trJac(3,4) = 1.; 
    trJac(2,3) = 1.;
    
    //first row
    trJac(0,0) = - sin(refTrackParametersToStore[Trk::phi0]);
    trJac(0,1) =   cos(refTrackParametersToStore[Trk::phi0]);
    
    //second row  
    trJac(1,0) = -cos(refTrackParametersToStore[Trk::phi0])/tan(refTrackParametersToStore[Trk::theta]); 
    trJac(1,1) = -sin(refTrackParametersToStore[Trk::phi0])/tan(refTrackParametersToStore[Trk::theta]);
    trJac(1,2) = 1.;
    
    AmgSymMatrix(5) perFullTrkCov = AmgSymMatrix(5)(trJac*fullTrkCov*trJac.transpose());
        Trk::PerigeeSurface pSurf(trk->linearizationPoint());
    Trk::TrackParameters* refittedPerigee = new Perigee(refTrackParametersToStore[0], 
                                refTrackParametersToStore[1], 
                                refTrackParametersToStore[2], 
                                refTrackParametersToStore[3], 
                                refTrackParametersToStore[4],
                                pSurf,
                                std::move(perFullTrkCov));
 
    //set the refitted track parameters
    (*TracksIter)->setPerigeeAtVertex(refittedPerigee);
      }
      
      
      //parameters difference 
      AmgVector(5) paramDifference = trackParameters - refTrackParameters;
      
      track_compatibility_chi2 += 
        (paramDifference.transpose()*trackParametersWeight*paramDifference)(0,0)*trackWeight;
      track_ndf+=2.;
      ATH_MSG_DEBUG ("new chi2 with compatibility of the tracks to the vertices " << 
                     track_compatibility_chi2 << " new ndf: " << track_ndf);    
    }//end iteration of tracks at vertex on jet axis
    
    if (!isPrimary) {
      track_ndf-=1.;//consider the vertex
    }
    if (!doFastUpdate) { // strange, the original fastSmoother didn't have such calculation
      //in the end calculate the real position... :-)
      const Amg::VectorX & vrt_removed_tracks_weight_times_vrt_pos =
         myPositionInWeightFormalism.position();
      const Amg::MatrixX & vrt_removed_tracks_weight =
         myPositionInWeightFormalism.covariancePosition();
      //perform a FAST inversion of the weight matrix - done here for the first time
      Amg::MatrixX vrt_removed_tracks_covariance = vrt_removed_tracks_weight;
 
      //4.October 2014 remove smartInversion for now (problems with numerical accuracy)
//      vrt_removed_tracks_covariance=vrt_removed_tracks_weight.inverse().eval();
    vrt_removed_tracks_covariance=(vrt_removed_tracks_covariance.transpose().eval()+vrt_removed_tracks_covariance)/2.0;
// After symmetrizing the matrix before inversion, the smart inversion works again, and move back. wesong@cern.ch 28/05/2016
      try 
      {
        m_Updator->smartInvert(vrt_removed_tracks_covariance);
      }
      catch (std::string a)
      {
        ATH_MSG_ERROR( a << " Doing inversion the normal way " );
        vrt_removed_tracks_covariance=vrt_removed_tracks_weight.inverse().eval();
      }
 
      const Amg::VectorX vrt_removed_tracks_pos=vrt_removed_tracks_covariance*vrt_removed_tracks_weight_times_vrt_pos;
    
      #ifdef KalmanVertexOnJetAxisSmoother_DEBUG
      std::cout << " final_vrt_pos " << final_vrt_pos << " vrt_removed_tracks_pos " << vrt_removed_tracks_pos << std::endl;
      std::cout << " weight removed tracks " << vrt_removed_tracks_weight << std::endl;
      #endif
 
      track_compatibility_chi2 += 
          ((final_vrt_pos-vrt_removed_tracks_pos).transpose()*vrt_removed_tracks_weight*(final_vrt_pos-vrt_removed_tracks_pos))(0,0);
 
 
      ATH_MSG_DEBUG (" new chi2 with the vertex residual" << track_compatibility_chi2 <<
                     " new ndf: " << track_ndf);
    }
    vertexToSmooth->setFitQuality(FitQuality(track_compatibility_chi2,track_ndf));
#ifdef KalmanVertexOnJetAxisSmoother_DEBUG
    std::cout << " vertexToSmooth pointer is " << vertexToSmooth << std::endl;
#endif
  
 }

update() [2/2]

void Trk::KalmanVertexOnJetAxisSmoother::update	(	VxVertexOnJetAxis *	vertexToSmooth,
		const VxJetCandidate *	candidateToUpdate,
		bool	updateTrack = true ) const

Update the VxVertexOnJetAxis (chi2 and ndf) with the knowledge coming from the fitted VxJetCandidate, updating (or not) also all the related track parameters of the tracks at the vertex (smoothing).

Definition at line 64 of file KalmanVertexOnJetAxisSmoother.cxx.

                                                 {
  
    const RecVertexPositions & myFinalPosition=candidateToUpdate->getRecVertexPositions();
    const VertexPositions & linearizationPositions=candidateToUpdate->getLinearizationVertexPositions();
    bool isPrimary = (vertexToSmooth==candidateToUpdate->getPrimaryVertex());
    update(vertexToSmooth,isPrimary,myFinalPosition,linearizationPositions,updateTrack,false);
    
  }

updateVHKA()

void AthCommonDataStore< AthCommonMsg< AlgTool > >::updateVHKA ( Gaudi::Details::PropertyBase & )

inlineinherited

Definition at line 308 of file AthCommonDataStore.h.

                                               {
    // debug() << "updateVHKA for property " << p.name() << " " << p.toString() 
    //         << "  size: " << m_vhka.size() << endmsg;
    for (auto &a : m_vhka) {
      std::vector<SG::VarHandleKey*> keys = a->keys();
      for (auto k : keys) {
        k->setOwner(this);
      }
    }
  }

Member Data Documentation

m_detStore

StoreGateSvc_t AthCommonDataStore< AthCommonMsg< AlgTool > >::m_detStore

privateinherited

Pointer to StoreGate (detector store by default)

Definition at line 393 of file AthCommonDataStore.h.

m_evtStore

StoreGateSvc_t AthCommonDataStore< AthCommonMsg< AlgTool > >::m_evtStore

privateinherited

Pointer to StoreGate (event store by default)

Definition at line 390 of file AthCommonDataStore.h.

m_initialMomentumError

double Trk::KalmanVertexOnJetAxisSmoother::m_initialMomentumError

private

Definition at line 104 of file KalmanVertexOnJetAxisSmoother.h.

m_maxWeight

double Trk::KalmanVertexOnJetAxisSmoother::m_maxWeight

private

Meaningless in case no adaptive fitting is used.

Adaptive finding will be implemented probably later also in the fit along the flight axis.

Definition at line 103 of file KalmanVertexOnJetAxisSmoother.h.

m_Updator

ToolHandle<KalmanVertexOnJetAxisUpdator> Trk::KalmanVertexOnJetAxisSmoother::m_Updator

private

Definition at line 96 of file KalmanVertexOnJetAxisSmoother.h.

m_varHandleArraysDeclared

bool AthCommonDataStore< AthCommonMsg< AlgTool > >::m_varHandleArraysDeclared

privateinherited

Definition at line 399 of file AthCommonDataStore.h.

m_vhka

std::vector<SG::VarHandleKeyArray*> AthCommonDataStore< AthCommonMsg< AlgTool > >::m_vhka

privateinherited

Definition at line 398 of file AthCommonDataStore.h.

---

The documentation for this class was generated from the following files:

• KalmanVertexOnJetAxisSmoother.h
• KalmanVertexOnJetAxisSmoother.cxx