#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 EventContext &ctx, 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`.
const ServiceHandle< StoreGateSvc > &	detStore () const
	The standard `StoreGateSvc/DetectorStore` Returns (kind of) a pointer to the `StoreGateSvc`.
virtual StatusCode	sysInitialize () override
	Perform system initialization for an algorithm.
virtual StatusCode	sysStart () override
	Handle START transition.
virtual std::vector< Gaudi::DataHandle * >	inputHandles () const override
	Return this algorithm's input handles.
virtual std::vector< Gaudi::DataHandle * >	outputHandles () const override
	Return this algorithm's output handles.
Gaudi::Details::PropertyBase &	declareProperty (Gaudi::Property< T, V, H > &t)
void	updateVHKA (Gaudi::Details::PropertyBase &)
MsgStream &	msg () const
bool	msgLvl (const MSG::Level lvl) const

Static Public Member Functions
static const InterfaceID &	interfaceID ()

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

Private Types
typedef ServiceHandle< StoreGateSvc >	StoreGateSvc_t

Private Member Functions
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 EventContext &ctx) const
Gaudi::Details::PropertyBase &	declareGaudiProperty (Gaudi::Property< T, V, H > &hndl, const SG::VarHandleKeyType &)
	specialization for handling Gaudi::Property<SG::VarHandleKey>

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).
StoreGateSvc_t	m_detStore
	Pointer to StoreGate (detector store by default).
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 55 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 108 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 EventContext &	ctx ) const

private

Definition at line 817 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,ctx)};
  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()

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

inlineprivateinherited

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

Definition at line 156 of file AthCommonDataStore.h.

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

◆ declareProperty()

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

inlineinherited

Definition at line 145 of file AthCommonDataStore.h.

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

◆ detStore()

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

inlineinherited

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

Definition at line 95 of file AthCommonDataStore.h.

95{ return m_detStore; }

AthCommonDataStore< AthCommonMsg< AlgTool > >::m_detStore

StoreGateSvc_t m_detStore

Definition AthCommonDataStore.h:393

◆ evtStore()

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

inlineinherited

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

Definition at line 85 of file AthCommonDataStore.h.

85{ return m_evtStore; }

AthCommonDataStore< AthCommonMsg< AlgTool > >::m_evtStore

StoreGateSvc_t m_evtStore

Definition AthCommonDataStore.h:390

◆ 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 130 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);
 
  if(m_doMultScatt)
    pTE->applyMultipleScattering();
 
  pTE->setTrackState(Rf);//restore
 
  if(m_doBremm)
    pTE->applyEnergyLoss(1);
 
  //quick check for covariance sanity
 
  for(int idx=0;idx<5;idx++) {
    if(pTE->getTrackCovariance(idx,idx) < 0) {
      ATH_MSG_DEBUG("REGTEST: cov(" << idx << "," << idx << ") =" << pTE->getTrackCovariance(idx,idx) << " < 0, reject track");
      delete pTE;
      return nullptr;
    }
  }
  
  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 88 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 566 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 572 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, ctx, 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 EventContext &	ctx,
		const Trk::ParticleHypothesis &	matEffects = Trk::pion,
		const bool	addTPtoTSoS = false ) const

Definition at line 598 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
        ATH_MSG_DEBUG("REGTEST: cov(" << i << "," << i << ") =" << cov_diag << " < 0, reject track");
    break;
      }
      (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, ctx);
            Trk::TrackStateOnSurface* pTSSwTP = nullptr;
            if( addTPtoTSoS ) pTSSwTP = createTrackStateOnSurface(*pnIt,true,ctx);
            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 101 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 888 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 73 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()

const InterfaceID & ITrigInDetTrackFitter::interfaceID ( )

inlinestaticinherited

Definition at line 24 of file ITrigInDetTrackFitter.h.

                                          {
    return IID_ITrigInDetTrackFitter;
  }

◆ msg()

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

inlineinherited

Definition at line 24 of file AthCommonMsg.h.

                                {
    return this->msgStream();
  }

◆ msgLvl()

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

inlineinherited

Definition at line 30 of file AthCommonMsg.h.

                                               {
    return this->msgLevel(lvl);
  }

◆ outputHandles()

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

overridevirtualinherited

Return this algorithm's output handles.

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

◆ renounce()

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

inlineprotectedinherited

Definition at line 380 of file AthCommonDataStore.h.

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

◆ renounceArray()

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

inlineprotectedinherited

remove all handles from I/O resolution

Definition at line 364 of file AthCommonDataStore.h.

                                                          {
    handlesArray.renounce();
  }

◆ sysInitialize()

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

overridevirtualinherited

Perform system initialization for an algorithm.

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

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

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

68{this, "AtlasFieldCacheCondObj", "fieldCondObj", "Name of the Magnetic Field conditions object key"};

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

◆ declareProperty()

◆ detStore()

◆ evtStore()

◆ extraDeps_update_handler()

◆ extrapolate()

◆ finalize()

◆ fit() [1/2]

◆ fit() [2/2]

◆ fitTrack()

◆ getMagneticField()

◆ getUnbiasedResiduals()

◆ initialize()

◆ inputHandles()

◆ interfaceID()

◆ msg()

◆ 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