PerigeeLinearizedTrackState.h

Go to the documentation of this file.

#ifndef PerigeeLinearizedTrackState_H
#define PerigeeLinearizedTrackState_H

#include "RecoVertex/VertexPrimitives/interface/LinearizedTrackState.h"
#include "TrackingTools/PatternTools/interface/TSCPBuilderNoMaterial.h"
#include "DataFormats/GeometrySurface/interface/ReferenceCounted.h"
#include "RecoVertex/VertexPrimitives/interface/LinearizedTrackState.h"
#include "Math/SMatrix.h"
#include "DataFormats/CLHEP/interface/Migration.h"
#include "FWCore/Utilities/interface/Likely.h"

class PerigeeLinearizedTrackState final : public LinearizedTrackState<5> {
public:
  friend class LinearizedTrackStateFactory;
  typedef ReferenceCountingPointer<LinearizedTrackState<5> > RefCountedLinearizedTrackState;

  RefCountedLinearizedTrackState stateWithNewLinearizationPoint(const GlobalPoint& newLP) const override;

  const GlobalPoint& linearizationPoint() const override { return theLinPoint; }

  reco::TransientTrack track() const override { return theTrack; }

  const TrajectoryStateOnSurface state() const { return theTSOS; }

  const AlgebraicVector5& constantTerm() const override;

  const AlgebraicMatrix53& positionJacobian() const override;

  const AlgebraicMatrix53& momentumJacobian() const override;

  const AlgebraicVector5& parametersFromExpansion() const override;

  const TrajectoryStateClosestToPoint& predictedState() const;

  AlgebraicVector5 predictedStateParameters() const override;

  AlgebraicVector3 predictedStateMomentumParameters() const override;

  AlgebraicSymMatrix55 predictedStateWeight(int& error) const override;

  AlgebraicSymMatrix55 predictedStateError() const override;

  AlgebraicSymMatrix33 predictedStateMomentumError() const override;

  //   /** Method returning the impact point measurement
  //    */
  //   ImpactPointMeasurement impactPointMeasurement() const;

  TrackCharge charge() const override { return theCharge; }

  bool hasError() const override;

  bool operator==(const LinearizedTrackState<5>& other) const override;

  bool operator==(const ReferenceCountingPointer<LinearizedTrackState<5> >& other) const;

  RefCountedRefittedTrackState createRefittedTrackState(const GlobalPoint& vertexPosition,
                                                        const AlgebraicVector3& vectorParameters,
                                                        const AlgebraicSymMatrix66& covarianceMatrix) const override;

  AlgebraicVector5 refittedParamFromEquation(const RefCountedRefittedTrackState& theRefittedState) const override;

  double weightInMixture() const override { return theTSOS.weight(); }

  void inline checkParameters(AlgebraicVector5& parameters) const override;

  std::vector<ReferenceCountingPointer<LinearizedTrackState<5> > > components() const override;

  bool isValid() const override;

private:
  PerigeeLinearizedTrackState(const GlobalPoint& linP,
                              const reco::TransientTrack& track,
                              const TrajectoryStateOnSurface& tsos)
      : theLinPoint(linP), theTrack(track), theTSOS(tsos), theCharge(theTrack.charge()), jacobiansAvailable(false) {}

  void computeJacobians() const;
  void computeChargedJacobians() const;
  void computeNeutralJacobians() const;
  void compute3DImpactPoint() const;

  GlobalPoint theLinPoint;
  reco::TransientTrack theTrack;
  const TrajectoryStateOnSurface theTSOS;

  mutable AlgebraicMatrix53 thePositionJacobian, theMomentumJacobian;
  mutable TrajectoryStateClosestToPoint thePredState;
  mutable AlgebraicVector5 theConstantTerm;
  mutable AlgebraicVector5 theExpandedParams;

  TSCPBuilderNoMaterial builder;

  TrackCharge theCharge;
  mutable bool jacobiansAvailable;
};

inline const AlgebraicVector5& PerigeeLinearizedTrackState::constantTerm() const {
  if UNLIKELY (!jacobiansAvailable)
    computeJacobians();
  return theConstantTerm;
}

inline const AlgebraicMatrix53& PerigeeLinearizedTrackState::positionJacobian() const {
  if UNLIKELY (!jacobiansAvailable)
    computeJacobians();
  return thePositionJacobian;
}

inline const AlgebraicMatrix53& PerigeeLinearizedTrackState::momentumJacobian() const {
  if UNLIKELY (!jacobiansAvailable)
    computeJacobians();
  return theMomentumJacobian;
}

inline const AlgebraicVector5& PerigeeLinearizedTrackState::parametersFromExpansion() const {
  if UNLIKELY (!jacobiansAvailable)
    computeJacobians();
  return theExpandedParams;
}

inline const TrajectoryStateClosestToPoint& PerigeeLinearizedTrackState::predictedState() const {
  if UNLIKELY (!jacobiansAvailable)
    computeJacobians();
  return thePredState;
}

inline bool PerigeeLinearizedTrackState::hasError() const {
  if UNLIKELY (!jacobiansAvailable)
    computeJacobians();
  return thePredState.hasError();
}

inline AlgebraicVector5 PerigeeLinearizedTrackState::predictedStateParameters() const {
  if (!jacobiansAvailable)
    computeJacobians();
  return thePredState.perigeeParameters().vector();
}

inline AlgebraicVector3 PerigeeLinearizedTrackState::predictedStateMomentumParameters() const {
  if UNLIKELY (!jacobiansAvailable)
    computeJacobians();
  auto v = thePredState.perigeeParameters().vector();
  return AlgebraicVector3(v[0], v[1], v[2]);
}

inline AlgebraicSymMatrix55 PerigeeLinearizedTrackState::predictedStateWeight(int& error) const {
  if UNLIKELY (!jacobiansAvailable)
    computeJacobians();
  if (!thePredState.isValid()) {
    error = 1;
    return AlgebraicSymMatrix55();
  }
  return thePredState.perigeeError().weightMatrix(error);
}

inline AlgebraicSymMatrix55 PerigeeLinearizedTrackState::predictedStateError() const {
  if UNLIKELY (!jacobiansAvailable)
    computeJacobians();
  return thePredState.perigeeError().covarianceMatrix();
}

inline AlgebraicSymMatrix33 PerigeeLinearizedTrackState::predictedStateMomentumError() const {
  if UNLIKELY (!jacobiansAvailable)
    computeJacobians();
  return thePredState.perigeeError().covarianceMatrix().Sub<AlgebraicSymMatrix33>(0, 2);
}

inline bool PerigeeLinearizedTrackState::isValid() const {
  if UNLIKELY (!theTSOS.isValid())
    return false;
  if UNLIKELY (!jacobiansAvailable)
    computeJacobians();
  return jacobiansAvailable;
}

#endif