#include <TrigInDetTrackFitter.h>

Inheritance diagram for TrigInDetTrackFitter:

Collaboration diagram for TrigInDetTrackFitter:

Public Member Functions
	TrigInDetTrackFitter (const std::string &, const std::string &, const IInterface *)

virtual StatusCode	initialize ()

virtual StatusCode	finalize ()

std::pair< Trk::Track , Trk::Track >	fitTrack (const Trk::Track &, MagField::AtlasFieldCache &, const Trk::ParticleHypothesis &matEffects=Trk::pion, const bool addTPtoTSoS=false) const

void	fit (const TrackCollection &, TrackCollection &, const EventContext &, const Trk::ParticleHypothesis &matEffects=Trk::pion) const

void	fit (const TrackCollection &, TrackCollection &, TrackCollection &, const EventContext &, const Trk::ParticleHypothesis &matEffects=Trk::pion, const bool addTPtoTSoS=false) const

StatusCode	getUnbiasedResiduals (const Trk::Track &, std::vector< TrigL2HitResidual > &, const EventContext &) const

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
Trk::TrkTrackState *	extrapolate (Trk::TrkTrackState , Trk::TrkPlanarSurface , Trk::TrkPlanarSurface *, MagField::AtlasFieldCache &) const

void	getMagneticField (double[3], double *, MagField::AtlasFieldCache &) const

void	correctScale (Trk::TrkTrackState *) const

Trk::TrackStateOnSurface *	createTrackStateOnSurface (Trk::TrkBaseNode *pN, const bool) const

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
std::atomic< size_t >	m_nTracksTotal

std::atomic< size_t >	m_fitErrorsUnresolved

std::atomic< size_t >	m_fitErrorsDivergence

std::atomic< size_t >	m_fitErrorsLowPt

double	m_DChi2

bool	m_doMultScatt

bool	m_doBremm

bool	m_correctClusterPos

ToolHandle< ITrigDkfTrackMakerTool >	m_trackMaker

ToolHandle< Trk::IRIO_OnTrackCreator >	m_ROTcreator

SG::ReadCondHandleKey< AtlasFieldCacheCondObj >	m_fieldCondObjInputKey {this, "AtlasFieldCacheCondObj", "fieldCondObj", "Name of the Magnetic Field conditions object key"}

const PixelID *	m_pixelId = nullptr

const SCT_ID *	m_sctId = nullptr

const AtlasDetectorID *	m_idHelper = nullptr

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

Definition at line 33 of file TrigInDetTrackFitter.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

◆ TrigInDetTrackFitter()

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

Definition at line 58 of file TrigInDetTrackFitter.cxx.

                                              : AthAlgTool(t,n,p),
                                    m_trackMaker("TrigDkfTrackMakerTool")
 {
   declareInterface< ITrigInDetTrackFitter >( this );
  
   declareProperty( "doMultScattering", m_doMultScatt = true);
   declareProperty( "doBremmCorrection", m_doBremm=false);
   declareProperty( "Chi2Cut", m_DChi2 = 1000.0);
   declareProperty( "correctClusterPos", m_correctClusterPos = false);
   declareProperty( "ROTcreator", m_ROTcreator, "ROTcreatorTool" );
   m_nTracksTotal = 0;
   m_fitErrorsUnresolved=0;
   m_fitErrorsDivergence=0;
   m_fitErrorsLowPt=0;
 }

Member Function Documentation

◆ correctScale()

void TrigInDetTrackFitter::correctScale ( Trk::TrkTrackState * pTS ) const

private

Definition at line 111 of file TrigInDetTrackFitter.cxx.

                                                                    {
  
   double Rf[5];
   double Gf[5][5];
   int i,j;
  
   for(i=0;i<4;i++) Rf[i] = pTS->getTrackState(i);
   Rf[4] = 0.001*pTS->getTrackState(4);
  
   for(i=0;i<4;i++)
     for(j=0;j<4;j++) Gf[i][j] = pTS->getTrackCovariance(i,j);
  
   Gf[0][4] = Gf[4][0] = pTS->getTrackCovariance(0,4)/1000.0;
   Gf[1][4] = Gf[4][1] = pTS->getTrackCovariance(1,4)/1000.0;
   Gf[2][4] = Gf[4][2] = pTS->getTrackCovariance(2,4)/1000.0;
   Gf[3][4] = Gf[4][3] = pTS->getTrackCovariance(3,4)/1000.0;
   Gf[4][4] = pTS->getTrackCovariance(4,4)/1000000.0;
  
   pTS->setTrackState(Rf);
   pTS->setTrackCovariance(Gf);
 }

◆ createTrackStateOnSurface()

Trk::TrackStateOnSurface * TrigInDetTrackFitter::createTrackStateOnSurface	(	Trk::TrkBaseNode *	pN,
		const bool	addTPtoTSoS
	)		const

private

Definition at line 811 of file TrigInDetTrackFitter.cxx.

 {
   Trk::TrackStateOnSurface* pTSS=nullptr;
   char type=pN->getNodeType();
   std::unique_ptr<Trk::TrackParameters> pTP{};
   if(type==0) return pTSS;
  
  
   Trk::TrkTrackState* pTS=pN->getTrackState();
   auto pM = AmgSymMatrix(5){};
   for(int i=0;i<5;i++) {
     for(int j=0;j<5;j++) {
       (pM)(i,j)=pTS->getTrackCovariance(i,j);
     }
   }
   const Trk::PrepRawData* pPRD=pN->getPrepRawData();
  
   if((type==1)||(type==2))
   {
     const Trk::Surface& rS = pPRD->detectorElement()->surface();
     const Trk::PlaneSurface* pPS = dynamic_cast<const Trk::PlaneSurface*>(&rS);
     if(pPS==nullptr) return pTSS;
  
       pTP=std::make_unique<Trk::AtaPlane>(pTS->getTrackState(0),
         pTS->getTrackState(1),
         pTS->getTrackState(2),
         pTS->getTrackState(3),
         pTS->getTrackState(4),*pPS,
         std::move(pM));
   }
   else if(type==3)
   {
     const Trk::Surface& rS = pPRD->detectorElement()->surface(pPRD->identify());
     const Trk::StraightLineSurface* pLS=dynamic_cast<const Trk::StraightLineSurface*>(&rS);
     if(pLS==nullptr) return pTSS;
  
     if((pTS->getTrackState(2)<-M_PI) ||(pTS->getTrackState(2)>M_PI)) {
       ATH_MSG_WARNING("Phi out of range when correcting Trk::TrackStateOnSurface");
     }
  
  
     pTP=std::make_unique<Trk::AtaStraightLine>(pTS->getTrackState(0),
         pTS->getTrackState(1),
         pTS->getTrackState(2),
         pTS->getTrackState(3),
         pTS->getTrackState(4),
         *pLS,
         std::move(pM));
   }
   if(pTP==nullptr) return nullptr;
   std::unique_ptr<Trk::RIO_OnTrack> pRIO{m_ROTcreator->correct(*pPRD,*pTP)};
   if(pRIO==nullptr) {
     return nullptr;
   }
   std::bitset<Trk::TrackStateOnSurface::NumberOfTrackStateOnSurfaceTypes> typePattern;
   typePattern.set(Trk::TrackStateOnSurface::Measurement);
   typePattern.set(Trk::TrackStateOnSurface::Scatterer);
   auto pFQ=Trk::FitQualityOnSurface(pN->getChi2(),pN->getNdof());
   if( addTPtoTSoS ) {
      std::bitset<Trk::TrackStateOnSurface::NumberOfTrackStateOnSurfaceTypes> typePatternwTP;
      typePatternwTP.set(Trk::TrackStateOnSurface::Measurement);
      typePatternwTP.set(Trk::TrackStateOnSurface::Scatterer);
      auto pFQwTP=Trk::FitQualityOnSurface(pN->getChi2(),pN->getNdof());
      pTSS = new Trk::TrackStateOnSurface(pFQwTP, pRIO->uniqueClone(), std::move(pTP), nullptr, typePatternwTP);
   }
   else {
      pTSS = new Trk::TrackStateOnSurface(pFQ, std::move(pRIO), nullptr, nullptr, typePattern);
   }
   return pTSS;
 }

◆ 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

◆ extrapolate()

Trk::TrkTrackState * TrigInDetTrackFitter::extrapolate	(	Trk::TrkTrackState *	pTS,
		Trk::TrkPlanarSurface *	pSB,
		Trk::TrkPlanarSurface *	pSE,
		MagField::AtlasFieldCache &	fieldCache
	)		const

private

Definition at line 133 of file TrigInDetTrackFitter.cxx.

 {
   const double C=0.02999975/1000.0;//using GeV internally
   const double minStep=30.0;
  
   double J[5][5],Rf[5],AG[5][5],Gf[5][5],A[5][5];
   int i,j,m;
  
   bool samePlane=false;
  
   if(pSB!=nullptr)
     {
       double diff=0.0;
       for(i=0;i<4;i++) diff+=fabs(pSE->getPar(i)-pSB->getPar(i));
       if(diff<1e-5) {
         samePlane=true;
         m_fitErrorsUnresolved++;
       }
     }
  
   if(!samePlane) {
  
     double gP[3],gPi[3],lP[3],gV[3],a,b,c,s,J0[7][5],descr,CQ,Ac,Av,Cc;
     double V[3],P[3],M[3][3],D[4],Jm[7][7],
       J1[5][7],gB[3],gBi[3],gBf[3],dBds[3],Buf[5][7],DVx,DVy,DVz;
     int nStep,nStepMax;
     double sl,ds;
  
     double sint,cost,sinf,cosf;
     sint=sin(pTS->getTrackState(3));cosf=cos(pTS->getTrackState(2));
     sinf=sin(pTS->getTrackState(2));cost=cos(pTS->getTrackState(3));
     gV[0]=sint*cosf;gV[1]=sint*sinf;gV[2]=cost;CQ=C*pTS->getTrackState(4);
  
     memset(&J0[0][0],0,sizeof(J0));
  
     if(pSB!=nullptr)
       {
     double L[3][3];
     lP[0]=pTS->getTrackState(0);lP[1]=pTS->getTrackState(1);lP[2]=0.0;
     pSB->transformPointToGlobal(lP,gP);
     for(i=0;i<3;i++) for(j=0;j<3;j++) L[i][j]=pSB->getInvRotMatrix(i,j);
  
     J0[0][0]=L[0][0];J0[0][1]=L[0][1];
     J0[1][0]=L[1][0];J0[1][1]=L[1][1];
     J0[2][0]=L[2][0];J0[2][1]=L[2][1];
     J0[3][2]=-sinf*sint;J0[3][3]=cosf*cost;
     J0[4][2]= cosf*sint;J0[4][3]=sinf*cost;
     J0[5][3]=-sint;
     J0[6][4]=1.0;
       }
     else
       {
     gP[0]=-pTS->getTrackState(0)*sinf;
     gP[1]= pTS->getTrackState(0)*cosf;
     gP[2]= pTS->getTrackState(1);
     J0[0][0]=-sinf;J0[0][2]=-pTS->getTrackState(0)*cosf;
     J0[1][0]= cosf;J0[1][2]=-pTS->getTrackState(0)*sinf;
     J0[2][1]=1.0;
     J0[3][2]=-sinf*sint;J0[3][3]=cosf*cost;
     J0[4][2]= cosf*sint;J0[4][3]=sinf*cost;
     J0[5][3]=-sint;
     J0[6][4]=1.0;
       }
     for(i=0;i<4;i++) D[i]=pSE->getPar(i);
     for(i=0;i<3;i++) gPi[i]=gP[i];
  
     getMagneticField(gP,gB, fieldCache);
  
     for(i=0;i<3;i++) gBi[i]=gB[i];
  
     c=D[0]*gP[0]+D[1]*gP[1]+D[2]*gP[2]+D[3];
     b=D[0]*gV[0]+D[1]*gV[1]+D[2]*gV[2];
     a=0.5*CQ*(gB[0]*(D[1]*gV[2]-D[2]*gV[1])+
           gB[1]*(D[2]*gV[0]-D[0]*gV[2])+
           gB[2]*(D[0]*gV[1]-D[1]*gV[0]));
  
     descr=b*b-4.0*a*c;
  
     if(descr<0.0)
       {
     //      printf("D<0 - extrapolation failed\n");
     return nullptr;
       }
  
     bool useExpansion=true;
     double ratio = 4*a*c/(b*b);
  
     if(fabs(ratio)>0.1)
       useExpansion = false;
  
     if(useExpansion) {
       sl=-c/b;
       sl=sl*(1-a*sl/b);
     }
     else {
       int signb = (b<0.0)?-1:1;
       sl = (-b+signb*sqrt(descr))/(2*a);
     }
  
     if(fabs(sl)<minStep) nStepMax=1;
     else
       {
     nStepMax=(int)(fabs(sl)/minStep)+1;
       }
     if((nStepMax<0)||(nStepMax>1000))
       {
     return nullptr;
       }
     Av=sl*CQ;
     Ac=0.5*sl*Av;
     DVx=gV[1]*gB[2]-gV[2]*gB[1];
     DVy=gV[2]*gB[0]-gV[0]*gB[2];
     DVz=gV[0]*gB[1]-gV[1]*gB[0];
  
     P[0]=gP[0]+gV[0]*sl+Ac*DVx;
     P[1]=gP[1]+gV[1]*sl+Ac*DVy;
     P[2]=gP[2]+gV[2]*sl+Ac*DVz;
     V[0]=gV[0]+Av*DVx;
     V[1]=gV[1]+Av*DVy;
     V[2]=gV[2]+Av*DVz;
  
     getMagneticField(P,gB,fieldCache);
  
     for(i=0;i<3;i++) gBf[i]=gB[i];
     for(i=0;i<3;i++)
       {
     dBds[i]=(gBf[i]-gBi[i])/sl;
     gB[i]=gBi[i];
       }
     nStep=nStepMax;
     while(nStep>0)
       {
     c=D[0]*gP[0]+D[1]*gP[1]+D[2]*gP[2]+D[3];
     b=D[0]*gV[0]+D[1]*gV[1]+D[2]*gV[2];
     a=0.5*CQ*(gB[0]*(D[1]*gV[2]-D[2]*gV[1])+
           gB[1]*(D[2]*gV[0]-D[0]*gV[2])+
           gB[2]*(D[0]*gV[1]-D[1]*gV[0]));
  
     ratio = 4*a*c/(b*b);
     if(fabs(ratio)>0.1)
       useExpansion = false;
     else useExpansion = true;
  
     if(useExpansion) {
       sl=-c/b;
       sl=sl*(1-a*sl/b);
     }
     else {
       descr=b*b-4.0*a*c;
       if(descr<0.0)
         {
           // printf("D<0 - extrapolation failed\n");
           return nullptr;
         }
       int signb = (b<0.0)?-1:1;
       sl = (-b+signb*sqrt(descr))/(2*a);
     }
  
     ds=sl/nStep;
     Av=ds*CQ;
     Ac=0.5*ds*Av;
     DVx=gV[1]*gB[2]-gV[2]*gB[1];
     DVy=gV[2]*gB[0]-gV[0]*gB[2];
     DVz=gV[0]*gB[1]-gV[1]*gB[0];
  
     P[0]=gP[0]+gV[0]*ds+Ac*DVx;
     P[1]=gP[1]+gV[1]*ds+Ac*DVy;
     P[2]=gP[2]+gV[2]*ds+Ac*DVz;
     V[0]=gV[0]+Av*DVx;
     V[1]=gV[1]+Av*DVy;
     V[2]=gV[2]+Av*DVz;
     for(i=0;i<3;i++)
       {
         gV[i]=V[i];gP[i]=P[i];
       }
     for(i=0;i<3;i++) gB[i]+=dBds[i]*ds;
     nStep--;
       }
     pSE->transformPointToLocal(gP,lP);
     Rf[0]=lP[0];Rf[1]=lP[1];
     Rf[2]=atan2(V[1],V[0]);
  
     if(fabs(V[2])>1.0)
       {
     return nullptr;
       }
  
     Rf[3]=acos(V[2]);
     Rf[4]=pTS->getTrackState(4);
  
     gV[0]=sint*cosf;gV[1]=sint*sinf;gV[2]=cost;
  
     for(i=0;i<4;i++) D[i]=pSE->getPar(i);
     for(i=0;i<3;i++) gP[i]=gPi[i];
  
     for(i=0;i<3;i++)
       {
     gB[i]=0.5*(gBi[i]+gBf[i]);
       }
  
     c=D[0]*gP[0]+D[1]*gP[1]+D[2]*gP[2]+D[3];
     b=D[0]*gV[0]+D[1]*gV[1]+D[2]*gV[2];
     a=CQ*(gB[0]*(D[1]*gV[2]-D[2]*gV[1])+
       gB[1]*(D[2]*gV[0]-D[0]*gV[2])+
       gB[2]*(D[0]*gV[1]-D[1]*gV[0]));
  
     ratio = 4*a*c/(b*b);
     if(fabs(ratio)>0.1)
       useExpansion = false;
     else useExpansion = true;
  
     if(useExpansion) {
       s=-c/b;
       s=s*(1-a*s/b);
     }
     else {
       descr=b*b-4.0*a*c;
       if(descr<0.0)
     {
       // printf("D<0 - extrapolation failed\n");
       return nullptr;
     }
       int signb = (b<0.0)?-1:1;
       s = (-b+signb*sqrt(descr))/(2*a);
     }
  
     Av=s*CQ;
     Ac=0.5*s*Av;
     Cc=0.5*s*s*C;
  
     DVx=gV[1]*gB[2]-gV[2]*gB[1];
     DVy=gV[2]*gB[0]-gV[0]*gB[2];
     DVz=gV[0]*gB[1]-gV[1]*gB[0];
  
     P[0]=gP[0]+gV[0]*s+Ac*DVx;
     P[1]=gP[1]+gV[1]*s+Ac*DVy;
     P[2]=gP[2]+gV[2]*s+Ac*DVz;
  
     V[0]=gV[0]+Av*DVx;V[1]=gV[1]+Av*DVy;V[2]=gV[2]+Av*DVz;
     if (std::abs(V[2]) > 1.0) {
       return nullptr;
     }
  
     pSE->transformPointToLocal(P,lP);
  
     memset(&Jm[0][0],0,sizeof(Jm));
  
     for(i=0;i<3;i++) for(j=0;j<3;j++) M[i][j]=pSE->getRotMatrix(i,j);
  
     double coeff[3], dadVx,dadVy,dadVz,dadQ,dsdx,dsdy,dsdz,dsdVx,dsdVy,dsdVz,dsdQ;
     coeff[0]=-c*c/(b*b*b);
     coeff[1]=c*(1.0+3.0*c*a/(b*b))/(b*b);
     coeff[2]=-(1.0+2.0*c*a/(b*b))/b;
  
     dadVx=0.5*CQ*(-D[1]*gB[2]+D[2]*gB[1]);
     dadVy=0.5*CQ*( D[0]*gB[2]-D[2]*gB[0]);
     dadVz=0.5*CQ*(-D[0]*gB[1]+D[1]*gB[0]);
     dadQ=0.5*C*(D[0]*DVx+D[1]*DVy+D[2]*DVz);
  
     dsdx=coeff[2]*D[0];
     dsdy=coeff[2]*D[1];
     dsdz=coeff[2]*D[2];
     dsdVx=coeff[0]*dadVx+coeff[1]*D[0];
     dsdVy=coeff[0]*dadVy+coeff[1]*D[1];
     dsdVz=coeff[0]*dadVz+coeff[1]*D[2];
     dsdQ=coeff[0]*dadQ;
  
     Jm[0][0]=1.0+V[0]*dsdx;
     Jm[0][1]=    V[0]*dsdy;
     Jm[0][2]=    V[0]*dsdz;
  
     Jm[0][3]=  s+V[0]*dsdVx;
     Jm[0][4]=    V[0]*dsdVy+Ac*gB[2];
     Jm[0][5]=    V[0]*dsdVz-Ac*gB[1];
     Jm[0][6]=    V[0]*dsdQ+Cc*DVx;
  
     Jm[1][0]=    V[1]*dsdx;
     Jm[1][1]=1.0+V[1]*dsdy;
     Jm[1][2]=    V[1]*dsdz;
  
     Jm[1][3]=    V[1]*dsdVx-Ac*gB[2];
     Jm[1][4]=  s+V[1]*dsdVy;
     Jm[1][5]=    V[1]*dsdVz+Ac*gB[0];
     Jm[1][6]=    V[1]*dsdQ+Cc*DVy;
  
     Jm[2][0]=    V[2]*dsdx;
     Jm[2][1]=    V[2]*dsdy;
     Jm[2][2]=1.0+V[2]*dsdz;
     Jm[2][3]=    V[2]*dsdVx+Ac*gB[1];
     Jm[2][4]=    V[2]*dsdVy-Ac*gB[0];
     Jm[2][5]=  s+V[2]*dsdVz;
     Jm[2][6]=    V[2]*dsdQ+Cc*DVz;
  
     Jm[3][0]=dsdx*CQ*DVx;
     Jm[3][1]=dsdy*CQ*DVx;
     Jm[3][2]=dsdz*CQ*DVx;
  
     Jm[3][3]=1.0+dsdVx*CQ*DVx;
     Jm[3][4]=CQ*(dsdVy*DVx+s*gB[2]);
     Jm[3][5]=CQ*(dsdVz*DVx-s*gB[1]);
  
     Jm[3][6]=(CQ*dsdQ+C*s)*DVx;
  
     Jm[4][0]=dsdx*CQ*DVy;
     Jm[4][1]=dsdy*CQ*DVy;
     Jm[4][2]=dsdz*CQ*DVy;
  
     Jm[4][3]=CQ*(dsdVx*DVy-s*gB[2]);
     Jm[4][4]=1.0+dsdVy*CQ*DVy;
     Jm[4][5]=CQ*(dsdVz*DVy+s*gB[0]);
  
     Jm[4][6]=(CQ*dsdQ+C*s)*DVy;
  
     Jm[5][0]=dsdx*CQ*DVz;
     Jm[5][1]=dsdy*CQ*DVz;
     Jm[5][2]=dsdz*CQ*DVz;
     Jm[5][3]=CQ*(dsdVx*DVz+s*gB[1]);
     Jm[5][4]=CQ*(dsdVy*DVz-s*gB[0]);
     Jm[5][5]=1.0+dsdVz*CQ*DVz;
     Jm[5][6]=(CQ*dsdQ+C*s)*DVz;
  
     Jm[6][6]=1.0;
  
     memset(&J1[0][0],0,sizeof(J1));
  
     J1[0][0]=M[0][0];J1[0][1]=M[0][1];J1[0][2]=M[0][2];
     J1[1][0]=M[1][0];J1[1][1]=M[1][1];J1[1][2]=M[1][2];
     J1[2][3]=-V[1]/(V[0]*V[0]+V[1]*V[1]);
     J1[2][4]= V[0]/(V[0]*V[0]+V[1]*V[1]);
     J1[3][5]=-1.0/sqrt(1-V[2]*V[2]);
     J1[4][6]=1.0;
  
     for(i=0;i<7;i++)
       {
     for(j=0;j<2;j++)
       Buf[j][i]=J1[j][0]*Jm[0][i]+J1[j][1]*Jm[1][i]+J1[j][2]*Jm[2][i];
     Buf[2][i]=J1[2][3]*Jm[3][i]+J1[2][4]*Jm[4][i];
     Buf[3][i]=J1[3][5]*Jm[5][i];
     Buf[4][i]=Jm[6][i];
       }
  
     if(pSB!=nullptr)
       {
     for(i=0;i<5;i++)
       {
         J[i][0]=Buf[i][0]*J0[0][0]+Buf[i][1]*J0[1][0]+Buf[i][2]*J0[2][0];
         J[i][1]=Buf[i][0]*J0[0][1]+Buf[i][1]*J0[1][1]+Buf[i][2]*J0[2][1];
         J[i][2]=Buf[i][3]*J0[3][2]+Buf[i][4]*J0[4][2];
         J[i][3]=Buf[i][3]*J0[3][3]+Buf[i][4]*J0[4][3]+Buf[i][5]*J0[5][3];
         J[i][4]=Buf[i][6];
       }
       }
     else
       {
     for(i=0;i<5;i++)
       {
         J[i][0]=Buf[i][0]*J0[0][0]+Buf[i][1]*J0[1][0];
         J[i][1]=Buf[i][2];
         J[i][2]=Buf[i][0]*J0[0][2]+Buf[i][1]*J0[1][2]+Buf[i][3]*J0[3][2]+Buf[i][4]*J0[4][2];
         J[i][3]=Buf[i][3]*J0[3][3]+Buf[i][4]*J0[4][3]+Buf[i][5]*J0[5][3];
         J[i][4]=Buf[i][6];
       }
       }
   }
   else {
     Rf[0]=pTS->getTrackState(0);
     Rf[1]=pTS->getTrackState(1);
     Rf[2]=pTS->getTrackState(2);
     Rf[3]=pTS->getTrackState(3);
     Rf[4]=pTS->getTrackState(4);
     memset(&J[0][0],0,sizeof(J));
     for(i=0;i<5;i++) J[i][i]=1.0;
   }
  
   for(i=0;i<5;i++) for(j=0;j<5;j++)
     {
       AG[i][j]=0.0;for(m=0;m<5;m++) AG[i][j]+=J[i][m]*pTS->getTrackCovariance(m,j);
     }
   for(i=0;i<5;i++) for(j=i;j<5;j++)
     {
       Gf[i][j]=0.0;
       for(m=0;m<5;m++) Gf[i][j]+=AG[i][m]*J[j][m];
       Gf[j][i]=Gf[i][j];
     }
  
   Trk::TrkTrackState* pTE=new Trk::TrkTrackState(pTS);
  
   //workaround to keep using existing TrkTrackState code
   double Rtmp[5];
  
   for(i=0;i<4;i++) Rtmp[i] = Rf[i];
   Rtmp[4] = 0.001*Rf[4];//GeV->MeV
  
   pTE->setTrackState(Rtmp);
   pTE->setTrackCovariance(Gf);
   pTE->attachToSurface(pSE);
  
   //  pTE->applyMaterialEffects();
   if(m_doMultScatt)
     pTE->applyMultipleScattering();
  
   pTE->setTrackState(Rf);//restore
  
   if(m_doBremm)
     pTE->applyEnergyLoss(1);
  
   AmgSymMatrix(5) Gi;
   for(i=0;i<5;i++) for(j=i;j<5;j++)
     {
       Gi.fillSymmetric(i, j, pTE->getTrackCovariance(i,j));
     }
   Gi = Gi.inverse();
  
   for(i=0;i<5;i++) for(j=0;j<5;j++)
     {
       A[i][j]=0.0;
       for(m=0;m<5;m++) A[i][j]+=AG[m][i]*Gi(m,j);
     }
   pTE->setPreviousState(pTS);
   pTE->setSmootherGain(A);
  
   return pTE;
 }

◆ finalize()

StatusCode TrigInDetTrackFitter::finalize ( )

virtual

Definition at line 91 of file TrigInDetTrackFitter.cxx.

 {
   ATH_MSG_INFO("==============================================================");
   ATH_MSG_INFO("TrigInDetTrackFitter::finalize() - LVL2 Track fit Statistics: ");
   ATH_MSG_INFO(" N tracks = "<<m_nTracksTotal);
   ATH_MSG_INFO("Problems detected: ");
   ATH_MSG_INFO("Unresolved spacepoints :"<< m_fitErrorsUnresolved);
   ATH_MSG_INFO("Extrapolator divergence:"<< m_fitErrorsDivergence);
   ATH_MSG_INFO("pT falls below 200 MeV :"<< m_fitErrorsLowPt);
   ATH_MSG_INFO("==============================================================");
   return StatusCode::SUCCESS;
 }

◆ fit() [1/2]

void TrigInDetTrackFitter::fit	(	const TrackCollection &	inputTracks,
		TrackCollection &	fittedTracks,
		const EventContext &	ctx,
		const Trk::ParticleHypothesis &	matEffects = `Trk::pion`
	)		const

virtual

Implements ITrigInDetTrackFitter.

Definition at line 560 of file TrigInDetTrackFitter.cxx.

 {
    TrackCollection tmp;
    fit(inputTracks,fittedTracks,tmp,ctx,matEffects,false);
 }

◆ fit() [2/2]

void TrigInDetTrackFitter::fit	(	const TrackCollection &	inputTracks,
		TrackCollection &	fittedTracks,
		TrackCollection &	fittedTrackswTP,
		const EventContext &	ctx,
		const Trk::ParticleHypothesis &	matEffects = `Trk::pion`,
		const bool	addTPtoTSoS = `false`
	)		const

virtual

Implements ITrigInDetTrackFitter.

Definition at line 566 of file TrigInDetTrackFitter.cxx.

 {
   MagField::AtlasFieldCache fieldCache;
  
   SG::ReadCondHandle<AtlasFieldCacheCondObj> fieldCondObj{m_fieldCondObjInputKey, ctx};
   if (!fieldCondObj.isValid()) {
     ATH_MSG_ERROR("Failed to retrieve AtlasFieldCacheCondObj with key " << m_fieldCondObjInputKey.key());
     return;
   }
  
   fieldCondObj->getInitializedCache (fieldCache);
   fittedTracks.reserve(inputTracks.size());
   if( addTPtoTSoS ) fittedTrackswTP.reserve(inputTracks.size());
   for(auto trIt = inputTracks.begin(); trIt != inputTracks.end(); ++trIt) {
                 Trk::Track* fittedTrack    = nullptr;
                 Trk::Track* fittedTrackwTP = nullptr;
         std::tie(fittedTrack,fittedTrackwTP) = fitTrack(**trIt, fieldCache, matEffects, addTPtoTSoS);
         if (fittedTrack!=nullptr) {
             fittedTracks.push_back(fittedTrack);
         }
         if (addTPtoTSoS && fittedTrackwTP!=nullptr) {
             fittedTrackswTP.push_back(fittedTrackwTP);
         }
     }
 }

◆ fitTrack()

std::pair< Trk::Track , Trk::Track > TrigInDetTrackFitter::fitTrack	(	const Trk::Track &	recoTrack,
		MagField::AtlasFieldCache &	fieldCache,
		const Trk::ParticleHypothesis &	matEffects = `Trk::pion`,
		const bool	addTPtoTSoS = `false`
	)		const

Definition at line 592 of file TrigInDetTrackFitter.cxx.

                                                                                                                                                                                                  {
  
     const Trk::TrackParameters* trackPars = recoTrack.perigeeParameters();
     if(trackPars==nullptr) {
         ATH_MSG_WARNING("Fit Failed -- TrkTrack has no parameters");
         return std::make_pair(nullptr,nullptr);
     }
  
     // 1. Create initial track state:
     double Rk[5];
     Rk[0] = trackPars->parameters()[Trk::d0];
     Rk[1] = trackPars->parameters()[Trk::z0];
     Rk[2] = trackPars->parameters()[Trk::phi0];
     if(Rk[2]>M_PI) Rk[2]-=2*M_PI;
     if(Rk[2]<-M_PI) Rk[2]+=2*M_PI;
     double trk_theta = trackPars->parameters()[Trk::theta];
     Rk[3] = trk_theta;
     double trk_qOverP = trackPars->parameters()[Trk::qOverP];
     Rk[4] = 1000.0*trk_qOverP;//MeV->GeV
     double trk_Pt = sin(trk_theta)/trk_qOverP;
  
     if(fabs(trk_Pt)<100.0)
     {
         ATH_MSG_DEBUG("Estimated Pt is too low "<<trk_Pt<<" - skipping fit");
         return std::make_pair(nullptr,nullptr);
     }
  
     // 2. Create filtering nodes
  
     std::vector<Trk::TrkBaseNode*> vpTrkNodes;
     std::vector<Trk::TrkTrackState*> vpTrackStates;
   vpTrackStates.reserve(vpTrkNodes.size() + 1);
     bool trackResult = m_trackMaker->createDkfTrack(recoTrack,vpTrkNodes, m_DChi2);
     int nHits=vpTrkNodes.size();
     ATH_MSG_VERBOSE(nHits<<" filtering nodes created");
  
     if(!trackResult) return std::make_pair(nullptr,nullptr);
  
     // 3. Main algorithm: filter and smoother (Rauch-Tung-Striebel)
   m_nTracksTotal++;
     Trk::TrkTrackState* pTS = new Trk::TrkTrackState(Rk);
     double Gk[5][5] = {{100.0,     0, 0,    0,    0},
                {0,     100.0, 0,    0,    0},
                {0,         0, 0.01, 0,    0},
                {0,         0, 0,    0.01, 0},
                {0,         0, 0,    0,   0.1}};
     pTS->setTrackCovariance(Gk);
     if(m_doMultScatt)
         pTS->setScatteringMode(1);
     if(m_doBremm)
         pTS->setScatteringMode(2);
     vpTrackStates.push_back(pTS);
  
     //ATH_MSG_DEBUG("Initial chi2: "<<recoTrack.chi2()<<" track authorId: "<<recoTrack.algorithmId());
     ATH_MSG_VERBOSE("Initial params: locT="<<Rk[0]<<" locL="<<Rk[1]<<" phi="<<Rk[2]
             <<" theta="<<Rk[3]<<" Q="<<Rk[4]<<" pT="<<sin(Rk[3])/Rk[4]<<" GeV");
  
     bool OK=true;
  
     double chi2tot=0.0;
     int ndoftot=-5;
  
     Trk::TrkPlanarSurface* pSB=nullptr;
     Trk::TrkPlanarSurface* pSE=nullptr;
     for(auto pnIt = vpTrkNodes.begin(); pnIt!=vpTrkNodes.end(); ++pnIt) {
         pSE=(*pnIt)->getSurface();
         Trk::TrkTrackState* pNS=extrapolate(pTS,pSB,pSE,fieldCache);
  
         pSB=pSE;
         if(pNS!=nullptr) {
             vpTrackStates.push_back(pNS);
  
             (*pnIt)->validateMeasurement(pNS);
             ATH_MSG_VERBOSE("dChi2="<<(*pnIt)->getChi2());
             if((*pnIt)->isValidated())
             {
                 chi2tot+=(*pnIt)->getChi2();
                 ndoftot+=(*pnIt)->getNdof();
             }
             (*pnIt)->updateTrackState(pNS);
             pTS=pNS;
             double est_Pt = 1000.0*sin(pTS->getTrackState(3))/pTS->getTrackState(4);
             if(fabs(est_Pt)<200.0)
             {
                 ATH_MSG_VERBOSE("Estimated Pt is too low "<<est_Pt<<" - skipping fit");
         m_fitErrorsLowPt++;
                 OK=false;break;
             }
         }
         else
         {
       m_fitErrorsDivergence++;
             OK=false;break;
         }
     }
     Trk::Track* fittedTrack    = nullptr;
     Trk::Track* fittedTrackwTP = nullptr;
     if(OK)
     {
         for(auto ptsIt = vpTrackStates.rbegin();ptsIt!=vpTrackStates.rend();++ptsIt)
         {
             (*ptsIt)->runSmoother();
         }
         pTS=(*vpTrackStates.begin());
         //correct GeV->MeV
  
         correctScale(pTS);
  
     double qOverP = pTS->getTrackState(4);
         double pt=sin(pTS->getTrackState(3))/pTS->getTrackState(4);
         double phi0 = pTS->getTrackState(2);
         if(phi0>M_PI) phi0-=2*M_PI;
         if(phi0<-M_PI) phi0+=2*M_PI;
     double theta = pTS->getTrackState(3);
         double z0 = pTS->getTrackState(1);
         double d0 = pTS->getTrackState(0);
     bool bad_cov = false;
     auto cov = AmgSymMatrix(5){};
     for(int i=0;i<5;i++) {
       double cov_diag = pTS->getTrackCovariance(i,i);
       if (cov_diag < 0) {
         bad_cov = true;//Diagonal elements must be positive
         break;
         ATH_MSG_DEBUG("REGTEST: cov(" << i << "," << i << ") =" << cov_diag << " < 0, reject track");
       }
       (cov)(i, i) = pTS->getTrackCovariance(i,i);
       for(int j=i+1;j<5;j++) {
         cov.fillSymmetric(i, j, pTS->getTrackCovariance(i,j));
       }
     }
  
         if((ndoftot<0) || (fabs(pt)<100.0) || (std::isnan(pt)) || bad_cov)
         {
           ATH_MSG_DEBUG("Fit failed - possibly floating point problem");
         }
         else
         {
       Trk::PerigeeSurface perigeeSurface;
       auto perigee = std::make_unique<Trk::Perigee>(d0, z0, phi0, theta, qOverP, perigeeSurface, cov);
       ATH_MSG_VERBOSE("perigee: " << *perigee);
       std::unique_ptr<Trk::Perigee> perigeewTP = (addTPtoTSoS) ?  std::make_unique<Trk::Perigee>(d0, z0, phi0, theta, qOverP, perigeeSurface, cov) : nullptr;
  
       std::bitset<Trk::TrackStateOnSurface::NumberOfTrackStateOnSurfaceTypes> typePattern;
       typePattern.set(Trk::TrackStateOnSurface::Perigee);
       auto pParVec    = std::make_unique<Trk::TrackStates>();
       auto pParVecwTP = std::make_unique<Trk::TrackStates>();
       if (m_correctClusterPos) {
         pParVec->reserve(vpTrkNodes.size()+1);
         pParVec->push_back(new Trk::TrackStateOnSurface(nullptr, std::move(perigee),nullptr, typePattern));
         if (addTPtoTSoS) {
           std::bitset<
             Trk::TrackStateOnSurface::NumberOfTrackStateOnSurfaceTypes>
             typePatternwTP;
           typePatternwTP.set(Trk::TrackStateOnSurface::Perigee);
           pParVecwTP->reserve(vpTrkNodes.size() + 1);
           pParVecwTP->push_back(
             new Trk::TrackStateOnSurface(nullptr, std::move(perigeewTP), nullptr, typePatternwTP));
         }
         for (auto pnIt = vpTrkNodes.begin(); pnIt != vpTrkNodes.end(); ++pnIt) {
           if((*pnIt)->isValidated()) {
             Trk::TrackStateOnSurface* pTSS    = createTrackStateOnSurface(*pnIt,false);
             Trk::TrackStateOnSurface* pTSSwTP = nullptr;
             if( addTPtoTSoS ) pTSSwTP = createTrackStateOnSurface(*pnIt,true);
             if(pTSS!=nullptr) {
               pParVec->push_back(pTSS);
             }
             if(pTSSwTP!=nullptr) {
               pParVecwTP->push_back(pTSSwTP);
             }
           }
         }
       }
       else {
         pParVec->reserve(recoTrack.trackStateOnSurfaces()->size());
         pParVec->push_back(new Trk::TrackStateOnSurface(nullptr, std::move(perigee),nullptr, typePattern));
  
         for (auto tSOS = recoTrack.trackStateOnSurfaces()->begin(); tSOS != recoTrack.trackStateOnSurfaces()->end(); ++tSOS) {
           //Don't store perigee - new perigee created above
           if ((*tSOS)->type(Trk::TrackStateOnSurface::Perigee) == false) {
             pParVec->push_back((*tSOS)->clone());
           }
         }
       }
       ATH_MSG_VERBOSE("Total chi2 ="<<chi2tot<<" NDOF="<<ndoftot);
       if(msgLvl(MSG::VERBOSE)) {
         double eta = -log(tan(0.5*theta));
       ATH_MSG_VERBOSE("Fitted parameters: d0="<<d0<<" phi0="<<phi0<<" z0="<<z0
           <<" eta0="<<eta<<" pt="<<pt);
       }
       auto pFQ= std::make_unique<Trk::FitQuality>(chi2tot,ndoftot);
       Trk::TrackInfo info(recoTrack.info());
       info.setParticleHypothesis(matEffects);
       fittedTrack = new Trk::Track(info, std::move(pParVec), std::move(pFQ));//fittedTrack now owns pParVec and pFQ
       if( addTPtoTSoS ) {
         auto pFQwTP=std::make_unique<Trk::FitQuality>(chi2tot,ndoftot);
         Trk::TrackInfo infowTP(recoTrack.info());
         infowTP.setParticleHypothesis(matEffects);
         fittedTrackwTP = new Trk::Track(infowTP, std::move(pParVecwTP), std::move(pFQwTP));//fittedTrack now owns pParVecwTP and pFQwTP
       }
     }
     }
     else
     {
         ATH_MSG_DEBUG("Forward Kalman filter: extrapolation failure ");
     }
  
     for(auto pnIt = vpTrkNodes.begin(); pnIt!=vpTrkNodes.end(); ++pnIt) {
         delete((*pnIt)->getSurface());
         delete (*pnIt);
     }
     vpTrkNodes.clear();
     for(auto ptsIt = vpTrackStates.begin();ptsIt!=vpTrackStates.end();++ptsIt) {
         delete (*ptsIt);
     }
     vpTrackStates.clear();
  
     return std::make_pair(fittedTrack,fittedTrackwTP);
 }

◆ getMagneticField()

void TrigInDetTrackFitter::getMagneticField	(	double	r[3],
		double *	B,
		MagField::AtlasFieldCache &	fieldCache
	)		const

private

Definition at line 104 of file TrigInDetTrackFitter.cxx.

                                                                                                             {
   B[0]=0.0;B[1]=0.0;B[2]=0.0;
     double field[3];
     fieldCache.getField(r,field);//field is returned in kT
     for(int i=0;i<3;i++) B[i]=field[i]/Gaudi::Units::kilogauss;//convert to kG
 }

◆ getUnbiasedResiduals()

StatusCode TrigInDetTrackFitter::getUnbiasedResiduals	(	const Trk::Track &	pT,
		std::vector< TrigL2HitResidual > &	vResid,
		const EventContext &	ctx
	)		const

virtual

Implements ITrigInDetTrackFitter.

Definition at line 882 of file TrigInDetTrackFitter.cxx.

                                                                          {
  
     const Trk::TrackParameters* trackPars = pT.perigeeParameters();
   if(trackPars==nullptr) {
     ATH_MSG_WARNING("Fit Failed -- TrkTrack has no parameters");
     return StatusCode::FAILURE;
   }
  
   MagField::AtlasFieldCache fieldCache;
  
   SG::ReadCondHandle<AtlasFieldCacheCondObj> fieldCondObj{m_fieldCondObjInputKey, ctx};
   if (!fieldCondObj.isValid()) {
     ATH_MSG_ERROR("Failed to retrieve AtlasFieldCacheCondObj with key " << m_fieldCondObjInputKey.key());
     return StatusCode::FAILURE;
   }
  
   fieldCondObj->getInitializedCache (fieldCache);
   std::vector<Trk::TrkBaseNode*> vpTrkNodes;
   std::vector<Trk::TrkTrackState*> vpTrackStates;
   vResid.clear();
   double trk_theta = trackPars->parameters()[Trk::theta];
   double trk_qOverP = trackPars->parameters()[Trk::qOverP];
   double Pt = sin(trk_theta)/trk_qOverP;
   if(fabs(Pt)<100.0)
   {
     ATH_MSG_DEBUG("TrigL2ResidualCalculator failed -- Estimated Pt is too low "<<Pt);
     return StatusCode::FAILURE;
   }
  
   // 1. Create filtering nodes
  
   bool trackResult = m_trackMaker->createDkfTrack(pT,vpTrkNodes, m_DChi2);
   if(!trackResult)
   {
     ATH_MSG_DEBUG("TrigDkfTrackMaker failed");
     return StatusCode::FAILURE;
   }
  
   bool OK=true;
   std::vector<Trk::TrkBaseNode*>::iterator pnIt,pnEnd(vpTrkNodes.end());
  
   for(std::vector<Trk::TrkBaseNode*>::iterator pNodeIt=vpTrkNodes.begin();pNodeIt!=vpTrkNodes.end();
       ++pNodeIt)
   {
     Trk::TrkBaseNode* pMaskedNode=(*pNodeIt);
     Trk::TrkTrackState* pMaskedState=nullptr;
  
     // 2. Create initial track state:
  
     double Rk[5];
     Rk[0] = trackPars->parameters()[Trk::d0];
     Rk[1] = trackPars->parameters()[Trk::z0];
     Rk[2] = trackPars->parameters()[Trk::phi0];
     if(Rk[2]>M_PI) Rk[2]-=2*M_PI;
     if(Rk[2]<-M_PI) Rk[2]+=2*M_PI;
     trk_theta = trackPars->parameters()[Trk::theta];
     Rk[3] = trk_theta;
     Rk[4] = 1000.0*trackPars->parameters()[Trk::qOverP];//MeV->GeV
     //No need to correct scale back - not returning track
  
     // 3. Main algorithm: filter and smoother (Rauch-Tung-Striebel)
  
     Trk::TrkTrackState* pTS = new Trk::TrkTrackState(Rk);
     double Gk[5][5] = {{100.0,     0, 0,    0,    0},
                        {0,     100.0, 0,    0,    0},
                        {0,         0, 0.01, 0,    0},
                        {0,         0, 0,    0.01, 0},
                        {0,         0, 0,    0,   0.1}};
     pTS->setTrackCovariance(Gk);
     if(m_doMultScatt)
       pTS->setScatteringMode(1);
     if(m_doBremm)
       pTS->setScatteringMode(2);
     vpTrackStates.push_back(pTS);
  
     ATH_MSG_DEBUG("Initial params: locT="<<Rk[0]<<" locL="<<Rk[1]<<" phi="<<Rk[2]
         <<" theta="<<Rk[3]<<" Q="<<Rk[4]<<" pT="<<sin(Rk[3])/Rk[4]);
  
     OK=true;
     Trk::TrkPlanarSurface *pSB=nullptr,*pSE;
  
     for(pnIt=vpTrkNodes.begin();pnIt!=pnEnd;++pnIt)
     {
       pSE=(*pnIt)->getSurface();
       Trk::TrkTrackState* pNS=extrapolate(pTS,pSB,pSE,fieldCache);
  
       pSB=pSE;
       if(pNS!=nullptr)
       {
         vpTrackStates.push_back(pNS);
  
         (*pnIt)->validateMeasurement(pNS);
         ATH_MSG_DEBUG("dChi2="<<(*pnIt)->getChi2());
         if((*pnIt)!=pMaskedNode)
         {
           (*pnIt)->updateTrackState(pNS);
         }
         else
         {
           pMaskedState=pNS;
         }
         pTS=pNS;
         Pt=sin(pTS->getTrackState(3))/pTS->getTrackState(4);
         if(fabs(Pt)<0.2)
         {
           ATH_MSG_DEBUG("Estimated Pt is too low "<<Pt<<" - skipping fit");
           OK=false;break;
         }
       }
       else
       {
         OK=false;break;
       }
     }
     if(OK)
     {
       std::vector<Trk::TrkTrackState*>::reverse_iterator ptsrIt(vpTrackStates.rbegin()),
         ptsrEnd(vpTrackStates.rend());
  
       for(;ptsrIt!=ptsrEnd;++ptsrIt)
       {
         (*ptsrIt)->runSmoother();
       }
  
       pMaskedNode->validateMeasurement(pMaskedState);
  
       double r[2],V[2][2];
  
       int nSize=pMaskedNode->getResiduals(r);
       nSize=pMaskedNode->getInverseResidualVariance(V);
       const Trk::PrepRawData* pPRD = pMaskedNode->getPrepRawData();
  
       Identifier id = pPRD->identify();
  
       Region region = Region::Undefined;
       if(m_idHelper->is_pixel(id))
       {
         region=(m_pixelId->is_barrel(id)) ? Region::PixBarrel: Region::PixEndcap;
         if (m_pixelId->is_blayer(id)) {
           region = Region::IBL;
         }
       }
       if(m_idHelper->is_sct(id))
       {
         region=(m_sctId->is_barrel(id)) ? Region::SctBarrel : Region::SctEndcap;
       }
       if(nSize==1) {
         if(V[0][0]>0.0) {
           vResid.push_back(TrigL2HitResidual(id,region,r[0],r[0]*sqrt(V[0][0])));
         }
         else {
           OK=false;
           break;
         }
       }
       else {
         if((V[0][0]>0.0) && (V[1][1]>0.0)) {
           vResid.push_back(TrigL2HitResidual(id,region,r[0],r[0]*sqrt(V[0][0]),
                 r[1],r[1]*sqrt(V[1][1])));
         }
         else {
           OK=false;
           break;
         }
       }
     }
     else
     {
       ATH_MSG_DEBUG("Forward Kalman filter: extrapolation failure ");
       vResid.clear();
     }
     for(std::vector<Trk::TrkTrackState*>::iterator ptsIt=vpTrackStates.begin();
         ptsIt!=vpTrackStates.end();++ptsIt) delete (*ptsIt);
     vpTrackStates.clear();
     if(!OK) break;
   }
   pnIt=vpTrkNodes.begin();pnEnd=vpTrkNodes.end();
   for(;pnIt!=pnEnd;++pnIt)
   {
     delete((*pnIt)->getSurface());
     delete (*pnIt);
   }
   vpTrkNodes.clear();
  
   if(OK) return StatusCode::SUCCESS;
   else return StatusCode::FAILURE;
  
 }

◆ initialize()

StatusCode TrigInDetTrackFitter::initialize ( )

virtual

Definition at line 76 of file TrigInDetTrackFitter.cxx.

 {
   ATH_CHECK(m_trackMaker.retrieve());
   if (m_correctClusterPos) {
     ATH_CHECK(m_ROTcreator.retrieve());
   }
   ATH_CHECK( m_fieldCondObjInputKey.initialize());
   ATH_CHECK(detStore()->retrieve(m_idHelper, "AtlasID"));
   ATH_CHECK(detStore()->retrieve(m_pixelId, "PixelID"));
   ATH_CHECK(detStore()->retrieve(m_sctId, "SCT_ID"));
  
   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& ITrigInDetTrackFitter::interfaceID ( )

inlinestaticinherited

Definition at line 24 of file ITrigInDetTrackFitter.h.

                                           {
     return IID_ITrigInDetTrackFitter;
   }

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

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

bool TrigInDetTrackFitter::m_correctClusterPos

private

Definition at line 65 of file TrigInDetTrackFitter.h.

◆ m_DChi2

double TrigInDetTrackFitter::m_DChi2

private

Definition at line 62 of file TrigInDetTrackFitter.h.

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

bool TrigInDetTrackFitter::m_doBremm

private

Definition at line 64 of file TrigInDetTrackFitter.h.

◆ m_doMultScatt

bool TrigInDetTrackFitter::m_doMultScatt

private

Definition at line 63 of file TrigInDetTrackFitter.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_fieldCondObjInputKey

SG::ReadCondHandleKey<AtlasFieldCacheCondObj> TrigInDetTrackFitter::m_fieldCondObjInputKey {this, "AtlasFieldCacheCondObj", "fieldCondObj", "Name of the Magnetic Field conditions object key"}

private

Definition at line 68 of file TrigInDetTrackFitter.h.

◆ m_fitErrorsDivergence

std::atomic<size_t> TrigInDetTrackFitter::m_fitErrorsDivergence

mutableprivate

Definition at line 59 of file TrigInDetTrackFitter.h.

◆ m_fitErrorsLowPt

std::atomic<size_t> TrigInDetTrackFitter::m_fitErrorsLowPt

mutableprivate

Definition at line 60 of file TrigInDetTrackFitter.h.

◆ m_fitErrorsUnresolved

std::atomic<size_t> TrigInDetTrackFitter::m_fitErrorsUnresolved

mutableprivate

Definition at line 58 of file TrigInDetTrackFitter.h.

◆ m_idHelper

const AtlasDetectorID* TrigInDetTrackFitter::m_idHelper = nullptr

private

Definition at line 71 of file TrigInDetTrackFitter.h.

◆ m_nTracksTotal

std::atomic<size_t> TrigInDetTrackFitter::m_nTracksTotal

mutableprivate

Definition at line 57 of file TrigInDetTrackFitter.h.

◆ m_pixelId

const PixelID* TrigInDetTrackFitter::m_pixelId = nullptr

private

Definition at line 69 of file TrigInDetTrackFitter.h.

◆ m_ROTcreator

ToolHandle<Trk::IRIO_OnTrackCreator> TrigInDetTrackFitter::m_ROTcreator

private

Definition at line 67 of file TrigInDetTrackFitter.h.

◆ m_sctId

const SCT_ID* TrigInDetTrackFitter::m_sctId = nullptr

private

Definition at line 70 of file TrigInDetTrackFitter.h.

◆ m_trackMaker

ToolHandle<ITrigDkfTrackMakerTool> TrigInDetTrackFitter::m_trackMaker

private

Definition at line 66 of file TrigInDetTrackFitter.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

◆ TrigInDetTrackFitter()

Member Function Documentation

◆ correctScale()

◆ createTrackStateOnSurface()

◆ 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()

◆ extrapolate()

◆ finalize()

◆ fit() [1/2]

◆ fit() [2/2]

◆ fitTrack()

◆ getMagneticField()

◆ getUnbiasedResiduals()

◆ initialize()

◆ inputHandles()

◆ interfaceID()

◆ msg() [1/2]

◆ msg() [2/2]

◆ msgLvl()

◆ outputHandles()

◆ renounce()

◆ renounceArray()

◆ sysInitialize()

◆ sysStart()

◆ updateVHKA()

Member Data Documentation

◆ m_correctClusterPos

◆ m_DChi2

◆ m_detStore

◆ m_doBremm

◆ m_doMultScatt

◆ m_evtStore

◆ m_fieldCondObjInputKey

◆ m_fitErrorsDivergence

◆ m_fitErrorsLowPt

◆ m_fitErrorsUnresolved

◆ m_idHelper

◆ m_nTracksTotal

◆ m_pixelId

◆ m_ROTcreator

◆ m_sctId

◆ m_trackMaker

◆ m_varHandleArraysDeclared

◆ m_vhka