#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. More...

	~KalmanVertexOnJetAxisSmoother ()
	Destructor. More...

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). More...

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). More...

ServiceHandle< StoreGateSvc > &	evtStore ()
	The standard `StoreGateSvc` (event store) Returns (kind of) a pointer to the `StoreGateSvc`. More...

const ServiceHandle< StoreGateSvc > &	evtStore () const
	The standard `StoreGateSvc` (event store) Returns (kind of) a pointer to the `StoreGateSvc`. More...

const ServiceHandle< StoreGateSvc > &	detStore () const
	The standard `StoreGateSvc/DetectorStore` Returns (kind of) a pointer to the `StoreGateSvc`. More...

virtual StatusCode	sysInitialize () override
	Perform system initialization for an algorithm. More...

virtual StatusCode	sysStart () override
	Handle START transition. More...

virtual std::vector< Gaudi::DataHandle * >	inputHandles () const override
	Return this algorithm's input handles. More...

virtual std::vector< Gaudi::DataHandle * >	outputHandles () const override
	Return this algorithm's output handles. More...

Gaudi::Details::PropertyBase &	declareProperty (Gaudi::Property< T > &t)

Gaudi::Details::PropertyBase *	declareProperty (const std::string &name, SG::VarHandleKey &hndl, const std::string &doc, const SG::VarHandleKeyType &)
	Declare a new Gaudi property. More...

Gaudi::Details::PropertyBase *	declareProperty (const std::string &name, SG::VarHandleBase &hndl, const std::string &doc, const SG::VarHandleType &)
	Declare a new Gaudi property. More...

Gaudi::Details::PropertyBase *	declareProperty (const std::string &name, SG::VarHandleKeyArray &hndArr, const std::string &doc, const SG::VarHandleKeyArrayType &)

Gaudi::Details::PropertyBase *	declareProperty (const std::string &name, T &property, const std::string &doc, const SG::NotHandleType &)
	Declare a new Gaudi property. More...

Gaudi::Details::PropertyBase *	declareProperty (const std::string &name, T &property, const std::string &doc="none")
	Declare a new Gaudi property. More...

void	updateVHKA (Gaudi::Details::PropertyBase &)

MsgStream &	msg () const

MsgStream &	msg (const MSG::Level lvl) 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 More...

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. More...

Private Types
typedef ServiceHandle< StoreGateSvc >	StoreGateSvc_t

Private Member Functions
	AmgSymMatrix (3) m_initial_cov_momentum

Gaudi::Details::PropertyBase &	declareGaudiProperty (Gaudi::Property< T > &hndl, const SG::VarHandleKeyType &)
	specialization for handling Gaudi::Property<SG::VarHandleKey> More...

Gaudi::Details::PropertyBase &	declareGaudiProperty (Gaudi::Property< T > &hndl, const SG::VarHandleKeyArrayType &)
	specialization for handling Gaudi::Property<SG::VarHandleKeyArray> More...

Gaudi::Details::PropertyBase &	declareGaudiProperty (Gaudi::Property< T > &hndl, const SG::VarHandleType &)
	specialization for handling Gaudi::Property<SG::VarHandleBase> More...

Gaudi::Details::PropertyBase &	declareGaudiProperty (Gaudi::Property< T > &t, const SG::NotHandleType &)
	specialization for handling everything that's not a Gaudi::Property<SG::VarHandleKey> or a <SG::VarHandleKeyArray> More...

Private Attributes
ToolHandle< KalmanVertexOnJetAxisUpdator >	m_Updator

double	m_maxWeight
	Meaningless in case no adaptive fitting is used. More...

double	m_initialMomentumError

StoreGateSvc_t	m_evtStore
	Pointer to StoreGate (event store by default) More...

StoreGateSvc_t	m_detStore
	Pointer to StoreGate (detector store by default) More...

std::vector< SG::VarHandleKeyArray * >	m_vhka

bool	m_varHandleArraysDeclared

Detailed Description

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() [1/4]

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

inlineprivateinherited

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

Definition at line 170 of file AthCommonDataStore.h.

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

◆ declareGaudiProperty() [2/4]

Gaudi::Details::PropertyBase& AthCommonDataStore< AthCommonMsg< AlgTool > >::declareGaudiProperty	(	Gaudi::Property< T > &	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());
  
   }

◆ declareGaudiProperty() [3/4]

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

inlineprivateinherited

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

Definition at line 184 of file AthCommonDataStore.h.

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

◆ declareGaudiProperty() [4/4]

Gaudi::Details::PropertyBase& AthCommonDataStore< AthCommonMsg< AlgTool > >::declareGaudiProperty	(	Gaudi::Property< T > &	t,
		const SG::NotHandleType &
	)

inlineprivateinherited

specialization for handling everything that's not a Gaudi::Property<SG::VarHandleKey> or a <SG::VarHandleKeyArray>

Definition at line 199 of file AthCommonDataStore.h.

   {
     return PBASE::declareProperty(t);
   }

◆ declareProperty() [1/6]

Gaudi::Details::PropertyBase* AthCommonDataStore< AthCommonMsg< AlgTool > >::declareProperty	(	const std::string &	name,
		SG::VarHandleBase &	hndl,
		const std::string &	doc,
		const SG::VarHandleType &
	)

inlineinherited

Declare a new Gaudi property.

Parameters

name	Name of the property.
hndl	Object holding the property value.
doc	Documentation string for the property.

This is the version for types that derive from SG::VarHandleBase. The property value object is put on the input and output lists as appropriate; then we forward to the base class.

Definition at line 245 of file AthCommonDataStore.h.

   {
     this->declare(hndl.vhKey());
     hndl.vhKey().setOwner(this);
  
     return PBASE::declareProperty(name,hndl,doc);
   }

◆ declareProperty() [2/6]

Gaudi::Details::PropertyBase* AthCommonDataStore< AthCommonMsg< AlgTool > >::declareProperty	(	const std::string &	name,
		SG::VarHandleKey &	hndl,
		const std::string &	doc,
		const SG::VarHandleKeyType &
	)

inlineinherited

Declare a new Gaudi property.

Parameters

name	Name of the property.
hndl	Object holding the property value.
doc	Documentation string for the property.

This is the version for types that derive from SG::VarHandleKey. The property value object is put on the input and output lists as appropriate; then we forward to the base class.

Definition at line 221 of file AthCommonDataStore.h.

   {
     this->declare(hndl);
     hndl.setOwner(this);
  
     return PBASE::declareProperty(name,hndl,doc);
   }

◆ declareProperty() [3/6]

Gaudi::Details::PropertyBase* AthCommonDataStore< AthCommonMsg< AlgTool > >::declareProperty	(	const std::string &	name,
		SG::VarHandleKeyArray &	hndArr,
		const std::string &	doc,
		const SG::VarHandleKeyArrayType &
	)

inlineinherited

Definition at line 259 of file AthCommonDataStore.h.

   {
  
     // std::ostringstream ost;
     // ost << Algorithm::name() << " VHKA declareProp: " << name 
     //     << " size: " << hndArr.keys().size() 
     //     << " mode: " << hndArr.mode() 
     //     << "  vhka size: " << m_vhka.size()
     //     << "\n";
     // debug() << ost.str() << endmsg;
  
     hndArr.setOwner(this);
     m_vhka.push_back(&hndArr);
  
     Gaudi::Details::PropertyBase* p =  PBASE::declareProperty(name, hndArr, doc);
     if (p != 0) {
       p->declareUpdateHandler(&AthCommonDataStore<PBASE>::updateVHKA, this);
     } else {
       ATH_MSG_ERROR("unable to call declareProperty on VarHandleKeyArray " 
                     << name);
     }
  
     return p;
  
   }

◆ declareProperty() [4/6]

Gaudi::Details::PropertyBase* AthCommonDataStore< AthCommonMsg< AlgTool > >::declareProperty	(	const std::string &	name,
		T &	property,
		const std::string &	doc,
		const SG::NotHandleType &
	)

inlineinherited

Declare a new Gaudi property.

Parameters

name	Name of the property.
property	Object holding the property value.
doc	Documentation string for the property.

This is the generic version, for types that do not derive from SG::VarHandleKey. It just forwards to the base class version of declareProperty.

Definition at line 333 of file AthCommonDataStore.h.

   {
     return PBASE::declareProperty(name, property, doc);
   }

◆ declareProperty() [5/6]

Gaudi::Details::PropertyBase* AthCommonDataStore< AthCommonMsg< AlgTool > >::declareProperty	(	const std::string &	name,
		T &	property,
		const std::string &	doc = `"none"`
	)

inlineinherited

Declare a new Gaudi property.

Parameters

name	Name of the property.
property	Object holding the property value.
doc	Documentation string for the property.

This dispatches to either the generic declareProperty or the one for VarHandle/Key/KeyArray.

Definition at line 352 of file AthCommonDataStore.h.

   {
     typedef typename SG::HandleClassifier<T>::type htype;
     return declareProperty (name, property, doc, htype());
   }

◆ declareProperty() [6/6]

Gaudi::Details::PropertyBase& AthCommonDataStore< AthCommonMsg< AlgTool > >::declareProperty ( Gaudi::Property< T > & 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.

95 { return m_detStore; }

◆ evtStore() [1/2]

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.

85 { return m_evtStore; }

◆ evtStore() [2/2]

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

inlineinherited

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

Definition at line 90 of file AthCommonDataStore.h.

90 { 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()

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

inlinestatic

Definition at line 66 of file KalmanVertexOnJetAxisSmoother.h.

      {
        return IID_KalmanVertexOnJetAxisSmoother;
      };

◆ msg() [1/2]

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

inlineinherited

Definition at line 24 of file AthCommonMsg.h.

                                 {
     return this->msgStream();
   }

◆ msg() [2/2]

MsgStream& AthCommonMsg< AlgTool >::msg ( const MSG::Level lvl ) const

inlineinherited

Definition at line 27 of file AthCommonMsg.h.

                                                   {
     return this->msgStream(lvl);
   }

◆ 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 DerivationFramework::CfAthAlgTool, AthCheckedComponent< AthAlgTool >, AthCheckedComponent<::AthAlgTool >, and asg::AsgMetadataTool.

◆ 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:

Public Member Functions

Static Public Member Functions

Protected Member Functions

Private Types

Private Member Functions

Private Attributes

Detailed Description

Member Typedef Documentation

◆ StoreGateSvc_t

Constructor & Destructor Documentation

◆ KalmanVertexOnJetAxisSmoother()

◆ ~KalmanVertexOnJetAxisSmoother()

Member Function Documentation

◆ AmgSymMatrix()

◆ declareGaudiProperty() [1/4]

◆ declareGaudiProperty() [2/4]

◆ declareGaudiProperty() [3/4]

◆ declareGaudiProperty() [4/4]

◆ declareProperty() [1/6]

◆ declareProperty() [2/6]

◆ declareProperty() [3/6]

◆ declareProperty() [4/6]

◆ declareProperty() [5/6]

◆ declareProperty() [6/6]

◆ detStore()

◆ evtStore() [1/2]

◆ evtStore() [2/2]

◆ extraDeps_update_handler()

◆ fastUpdate()

◆ initialize()

◆ inputHandles()

◆ interfaceID()

◆ msg() [1/2]

◆ msg() [2/2]

◆ msgLvl()

◆ outputHandles()

◆ renounce()

◆ renounceArray()

◆ sysInitialize()

◆ sysStart()

◆ update() [1/2]

◆ update() [2/2]

◆ updateVHKA()

Member Data Documentation

◆ m_detStore

◆ m_evtStore

◆ m_initialMomentumError

◆ m_maxWeight

◆ m_Updator

◆ m_varHandleArraysDeclared

◆ m_vhka