TrajectoryToResiduals.cc File Reference

#include "TrajectoryToResiduals.h"
#include "TrackingTools/PatternTools/interface/Trajectory.h"
#include "TrackingTools/TrackFitters/interface/TrajectoryStateCombiner.h"
#include "FWCore/MessageLogger/interface/MessageLogger.h"

Go to the source code of this file.

Functions
reco::TrackResiduals	trajectoryToResiduals (const Trajectory &trajectory)

Function Documentation

reco::TrackResiduals trajectoryToResiduals

(

const Trajectory &

trajectory

)

Definition at line 7 of file TrajectoryToResiduals.cc.

References alongMomentum, TrajectoryMeasurement::backwardPredictedState(), funct::combine(), Trajectory::direction(), TrajectoryMeasurement::forwardPredictedState(), mps_fire::i, TrajectoryStateOnSurface::isValid(), TrajectoryStateOnSurface::localError(), TrajectoryStateOnSurface::localPosition(), Trajectory::measurements(), LocalTrajectoryError::positionError(), TrajectoryMeasurement::recHit(), reco::TrackResiduals::resize(), reco::TrackResiduals::setPullXY(), reco::TrackResiduals::setResidualXY(), mathSSE::sqrt(), gpuClustering::x, PV3DBase< T, PVType, FrameType >::x(), LocalError::xx(), detailsBasic3DVector::y, PV3DBase< T, PVType, FrameType >::y(), and LocalError::yy().

Referenced by KfTrackProducerBase::putInEvt().

                                                                       {
  reco::TrackResiduals residuals;
  residuals.resize(trajectory.measurements().size());
  int i_residual = 0;
  Trajectory::DataContainer::const_iterator i_fwd = trajectory.measurements().begin();
  Trajectory::DataContainer::const_reverse_iterator i_bwd = trajectory.measurements().rbegin();
  Trajectory::DataContainer::const_iterator i_end = trajectory.measurements().end();
  Trajectory::DataContainer::const_reverse_iterator i_rend = trajectory.measurements().rend();
  bool forward = trajectory.direction() == alongMomentum;
  for (; forward ? i_fwd != i_end : i_bwd != i_rend; ++i_fwd, ++i_bwd, ++i_residual) {
    const TrajectoryMeasurement *i = forward ? &*i_fwd : &*i_bwd;
    if (!i->recHit()->isValid() || i->recHit()->det() == nullptr)
      continue;
    TrajectoryStateCombiner combine;
    if (!i->forwardPredictedState().isValid() || !i->backwardPredictedState().isValid()) {
      edm::LogError("InvalideState") << "one of the step is invalid";
      continue;
    }

    TrajectoryStateOnSurface &&combo = combine(i->forwardPredictedState(), i->backwardPredictedState());

    if (!combo.isValid()) {
      edm::LogError("InvalideState") << "the combined state is invalid";
      continue;
    }

    LocalPoint &&combo_localpos = combo.localPosition();
    LocalError &&combo_localerr = combo.localError().positionError();
    LocalPoint &&dethit_localpos = i->recHit()->localPosition();
    LocalError &&dethit_localerr = i->recHit()->localPositionError();
    auto const &error_including_alignment = dethit_localerr;  // align error nwo is included
    {
      auto x = (dethit_localpos.x() - combo_localpos.x());
      auto y = (dethit_localpos.y() - combo_localpos.y());
      residuals.setResidualXY(i_residual, x, y);
    }
    {
      auto x =
          (dethit_localpos.x() - combo_localpos.x()) / std::sqrt(error_including_alignment.xx() + combo_localerr.xx());
      auto y =
          (dethit_localpos.y() - combo_localpos.y()) / std::sqrt(error_including_alignment.yy() + combo_localerr.yy());
      residuals.setPullXY(i_residual, x, y);
    }
  }
  return residuals;
}