MultiTrajectory.h

Go to the documentation of this file.

/*
  Copyright (C) 2002-2025 CERN for the benefit of the ATLAS collaboration
*/
#ifndef ActsEvent_MultiTrajectory_h
#define ActsEvent_MultiTrajectory_h
#include <memory>
#include <type_traits>
#include <variant>
#include <string_view>
 
#include "Acts/EventData/MultiTrajectory.hpp"
#include "Acts/EventData/SourceLink.hpp"
#include "Acts/EventData/TrackStatePropMask.hpp"
#include "Acts/EventData/VectorMultiTrajectory.hpp"
#include "Acts/Utilities/HashedString.hpp"
#include "Acts/Geometry/TrackingGeometry.hpp"
#include "ActsGeometryInterfaces/ActsGeometryContext.h"
#include "Acts/Surfaces/Surface.hpp"
#include "CxxUtils/concepts.h"
#include "xAODTracking/TrackJacobianAuxContainer.h"
#include "xAODTracking/TrackMeasurementAuxContainer.h"
#include "xAODTracking/TrackParametersAuxContainer.h"
#include "xAODTracking/TrackStateContainer.h"
#include "xAODTracking/TrackStateAuxContainer.h"
#include "xAODTracking/TrackSurfaceAuxContainer.h"
#include "xAODTracking/TrackSurfaceContainer.h"
#include "ActsGeometry/ATLASSourceLink.h"
// #define DEBUG_MTJ
#ifdef DEBUG_MTJ
#define INSPECTCALL(_INFO) {std::cout << __FILE__ <<":"<<__LINE__<<" "<<__PRETTY_FUNCTION__<<" "<<_INFO<<std::endl; }
#else
#define INSPECTCALL(_INFO)
#endif
#include "ActsEvent/Decoration.h"
 
namespace ActsTrk {
class MutableMultiTrajectory;
class MultiTrajectory;
class MutableTrackContainerHandlesHelper;
}  // namespace ActsTrk
 
namespace Acts {
class Surface;
template <typename T>
struct IsReadOnlyMultiTrajectory {};
 
template <typename T>
struct IsReadOnlyMultiTrajectory<T&> : IsReadOnlyMultiTrajectory<T> {};
 
template <typename T>
struct IsReadOnlyMultiTrajectory<T&&> : IsReadOnlyMultiTrajectory<T> {};
 
template <>
struct IsReadOnlyMultiTrajectory<ActsTrk::MultiTrajectory>
    : std::true_type {};
 
template <>
struct IsReadOnlyMultiTrajectory<ActsTrk::MutableMultiTrajectory>
    : std::false_type {};
}  // namespace Acts
 
namespace ActsTrk {
 
using IndexType = std::uint32_t;
 
using StoredSurface = std::variant<const Acts::Surface*, std::shared_ptr<const Acts::Surface>>;
 
 
class MutableMultiTrajectory final
    : public Acts::MultiTrajectory<ActsTrk::MutableMultiTrajectory> {
 public:
  friend ActsTrk::MultiTrajectory;
  using TrackStateProxy = typename Acts::MultiTrajectory<
      ActsTrk::MutableMultiTrajectory>::TrackStateProxy;
  using ConstTrackStateProxy = typename Acts::MultiTrajectory<
      ActsTrk::MutableMultiTrajectory>::ConstTrackStateProxy;
 
  MutableMultiTrajectory();
  MutableMultiTrajectory(const ActsTrk::MutableMultiTrajectory& other);
  MutableMultiTrajectory(ActsTrk::MutableMultiTrajectory&& other) = default;
  MutableMultiTrajectory& operator=(const ActsTrk::MutableMultiTrajectory& other) = delete;
 
  ActsTrk::IndexType addTrackState_impl(Acts::TrackStatePropMask mask,
                                        ActsTrk::IndexType iprevious);
 
  void addTrackStateComponents_impl(ActsTrk::IndexType istate,
                                    Acts::TrackStatePropMask mask);
 
  std::any component_impl(Acts::HashedString key, ActsTrk::IndexType istate) const;
  std::any component_impl(Acts::HashedString key, ActsTrk::IndexType istate);
 
  bool has_impl(Acts::HashedString key, ActsTrk::IndexType istate) const;
 
  constexpr bool hasColumn_impl(Acts::HashedString key) const;
 
  template <typename T>
  void addColumn_impl(std::string_view key);
 
  void unset_impl(Acts::TrackStatePropMask target, ActsTrk::IndexType istate);
 
  void shareFrom_impl(ActsTrk::IndexType iself, ActsTrk::IndexType iother,
                      Acts::TrackStatePropMask shareSource,
                      Acts::TrackStatePropMask shareTarget);
 
  typename ConstTrackStateProxy::Parameters parameters_impl(
      ActsTrk::IndexType index) const {
    return typename ConstTrackStateProxy::Parameters{m_trackParametersAux->params[index].data()};
  }
 
  typename TrackStateProxy::Parameters parameters_impl(ActsTrk::IndexType index) {
    return typename TrackStateProxy::Parameters{m_trackParametersAux->params[index].data()};
  }
 
  typename ConstTrackStateProxy::Covariance covariance_impl(
      ActsTrk::IndexType index) const {
    return typename ConstTrackStateProxy::Covariance{m_trackParametersAux->covMatrix[index].data()};
  }
  typename TrackStateProxy::Covariance covariance_impl(ActsTrk::IndexType index) {
    return typename TrackStateProxy::Covariance{m_trackParametersAux->covMatrix[index].data()};
  }
 
  typename ConstTrackStateProxy::Covariance trackMeasurementsCov(
      ActsTrk::IndexType index) const {
    return typename ConstTrackStateProxy::Covariance{m_trackMeasurementsAux->covMatrix[index].data()};
 
  }
 
  typename TrackStateProxy::Covariance trackMeasurementsCov(ActsTrk::IndexType index) {
    return typename TrackStateProxy::Covariance{m_trackMeasurementsAux->covMatrix[index].data()};
 
  }
 
  inline typename ConstTrackStateProxy::Covariance jacobian_impl(
      ActsTrk::IndexType istate) const {
    xAOD::TrackStateIndexType jacIdx = m_trackStatesAux->jacobian[istate];
    return typename ConstTrackStateProxy::Covariance{m_trackJacobiansAux->jac[jacIdx].data()};
  }
 
  typename TrackStateProxy::Covariance jacobian_impl(ActsTrk::IndexType istate) {
    xAOD::TrackStateIndexType jacIdx = m_trackStatesAux->jacobian[istate];
    return typename TrackStateProxy::Covariance{m_trackJacobiansAux->jac[jacIdx].data()};
  }
 
  template <std::size_t measdim>
  inline typename ConstTrackStateProxy::template Calibrated<measdim>
  calibrated_impl(ActsTrk::IndexType index) const {
    xAOD::TrackStateIndexType measIdx = m_trackStatesAux->calibrated[index];
    return typename ConstTrackStateProxy::template Calibrated<measdim>{m_trackMeasurementsAux->meas[measIdx].data()};
  }
 
  template <std::size_t measdim, bool Enable = true>
  std::enable_if_t<Enable,
                   typename TrackStateProxy::template Calibrated<measdim>>
  calibrated_impl(ActsTrk::IndexType index) {
    xAOD::TrackStateIndexType measIdx = m_trackStatesAux->calibrated[index];
    return typename TrackStateProxy::template Calibrated<measdim>{m_trackMeasurementsAux->meas[measIdx].data()};
  }
 
  template <std::size_t measdim>
  inline typename ConstTrackStateProxy::template CalibratedCovariance<measdim>
  calibratedCovariance_impl(ActsTrk::IndexType index) const {
    xAOD::TrackStateIndexType measIdx = m_trackStatesAux->calibrated[index];
    return ConstTrackStateProxy::template CalibratedCovariance<measdim>{m_trackMeasurementsAux->covMatrix[measIdx].data()};
  }
  template <std::size_t measdim, bool Enable = true>
  std::enable_if_t<
      Enable, typename TrackStateProxy::template CalibratedCovariance<measdim>>
  calibratedCovariance_impl(ActsTrk::IndexType index) {
    xAOD::TrackStateIndexType measIdx = m_trackStatesAux->calibrated[index];
    return TrackStateProxy::template CalibratedCovariance<measdim>{m_trackMeasurementsAux->covMatrix[measIdx].data()};
  }
 
  inline Acts::TrackIndexType size_impl() const {
    return m_trackStatesSize;
  }
 
  void clear_impl();
 
  bool has_backends() const;
 
  template <typename val_t, typename cov_t>
  void allocateCalibrated_impl(IndexType istate,
                               const Eigen::DenseBase<val_t>& val,
                               const Eigen::DenseBase<cov_t>& cov)
    requires(Eigen::PlainObjectBase<val_t>::RowsAtCompileTime > 0 &&
             Eigen::PlainObjectBase<val_t>::RowsAtCompileTime <= Acts::eBoundSize &&
             Eigen::PlainObjectBase<val_t>::RowsAtCompileTime ==
                 Eigen::PlainObjectBase<cov_t>::RowsAtCompileTime &&
             Eigen::PlainObjectBase<cov_t>::RowsAtCompileTime ==
                 Eigen::PlainObjectBase<cov_t>::ColsAtCompileTime);
 
  ActsTrk::IndexType calibratedSize_impl(ActsTrk::IndexType istate) const;
 
  void setUncalibratedSourceLink_impl(ActsTrk::IndexType istate,
                                      const Acts::SourceLink& sourceLink);
 
  typename Acts::SourceLink getUncalibratedSourceLink_impl(
      ActsTrk::IndexType istate) const;
 
  void setReferenceSurface_impl(IndexType,
                                std::shared_ptr<const Acts::Surface>);
  const Acts::Surface* referenceSurface_impl(IndexType ) const;
 
  void copyDynamicFrom_impl (ActsTrk::IndexType istate,
                             Acts::HashedString key,
                             const std::any& src_ptr);
  std::vector<Acts::HashedString> dynamicKeys_impl() const;
 
  // access to some backends (for debugging purposes)
  // the receiver should not assume ownership or similar
  inline xAOD::TrackStateAuxContainer* trackStatesAux() { return m_trackStatesAux.get(); }
 
  inline const xAOD::TrackParametersAuxContainer* trackParametersAux() const {
    return m_trackParametersAux.get();
  }
  inline xAOD::TrackParametersAuxContainer* trackParametersAux() {
    return m_trackParametersAux.get();
  }
 
  inline xAOD::TrackJacobianAuxContainer* trackJacobiansAux() {
    return m_trackJacobiansAux.get();
  }
 
  inline xAOD::TrackMeasurementAuxContainer* trackMeasurementsAux() {
    return m_trackMeasurementsAux.get();
  }
 
  inline xAOD::TrackSurfaceAuxContainer* trackSurfacesAux() {
    return m_surfacesBackendAux.get();
  }
 
  static const std::set<std::string> s_staticVariables;
 
  friend ActsTrk::MutableTrackContainerHandlesHelper;
 
 private:
 
  std::unique_ptr<xAOD::TrackStateAuxContainer> m_trackStatesAux;
  size_t m_trackStatesSize = 0;
 
  std::unique_ptr<xAOD::TrackParametersAuxContainer> m_trackParametersAux;
  size_t m_trackParametersSize = 0;
 
  std::unique_ptr<xAOD::TrackJacobianAuxContainer> m_trackJacobiansAux;
  size_t m_trackJacobiansSize = 0;
 
  std::unique_ptr<xAOD::TrackMeasurementAuxContainer> m_trackMeasurementsAux;
  size_t m_trackMeasurementsSize = 0;
 
  std::unique_ptr<xAOD::TrackSurfaceContainer> m_surfacesBackend;
  std::unique_ptr<xAOD::TrackSurfaceAuxContainer> m_surfacesBackendAux;
  std::vector<ActsTrk::detail::Decoration> m_decorations;
 
  std::vector<std::optional<Acts::SourceLink>> m_calibratedSourceLinks;
  std::vector<std::optional<Acts::SourceLink>> m_uncalibratedSourceLinks;
 
  std::vector<StoredSurface> m_surfaces;
  ActsGeometryContext m_geoContext;
 
  xAOD::TrackStateContainer m_trackStatesIface;
 
  // adjust preallocated size to actually used
  void trim();
};
 
class MultiTrajectory
    : public Acts::MultiTrajectory<MultiTrajectory> {
 public:
 
  MultiTrajectory(
      DataLink<xAOD::TrackStateAuxContainer> trackStates,
      DataLink<xAOD::TrackParametersAuxContainer> trackParameters,
      DataLink<xAOD::TrackJacobianAuxContainer> trackJacobians,
      DataLink<xAOD::TrackMeasurementAuxContainer> trackMeasurements,
      DataLink<xAOD::TrackSurfaceAuxContainer> trackSurfaces);
 
  MultiTrajectory(ActsTrk::MutableMultiTrajectory& other);
 
  bool has_impl(Acts::HashedString key, ActsTrk::IndexType istate) const;
 
  std::any component_impl(Acts::HashedString key, ActsTrk::IndexType istate) const;
 
  bool hasColumn_impl(Acts::HashedString key) const;
 
  typename ConstTrackStateProxy::Parameters parameters_impl(
      ActsTrk::IndexType index) const {
    return typename ConstTrackStateProxy::Parameters{m_trackParametersAux->params[index].data()};
  }
 
  typename ConstTrackStateProxy::Covariance covariance_impl(
      ActsTrk::IndexType index) const {
    return  typename ConstTrackStateProxy::Covariance{m_trackParametersAux->covMatrix[index].data()};
  }
 
  inline typename ConstTrackStateProxy::Covariance jacobian_impl(
      ActsTrk::IndexType istate) const {
    xAOD::TrackStateIndexType jacIdx = m_trackStatesAux->jacobian[istate];
    return typename ConstTrackStateProxy::Covariance{m_trackJacobiansAux->jac[jacIdx].data()};
  }
 
  template <std::size_t measdim>
  inline typename ConstTrackStateProxy::template Calibrated<measdim>
  calibrated_impl(IndexType istate) const {
    xAOD::TrackStateIndexType measIdx = m_trackStatesAux->calibrated[istate];
    return typename ConstTrackStateProxy::template Calibrated<measdim>{m_trackMeasurementsAux->meas[measIdx].data()};
  }
 
  template <std::size_t measdim>
  inline typename ConstTrackStateProxy::template CalibratedCovariance<measdim>
  calibratedCovariance_impl(IndexType index) const {
    xAOD::TrackStateIndexType measIdx = m_trackStatesAux->calibrated[index];
    return typename ConstTrackStateProxy::template CalibratedCovariance<measdim>{m_trackMeasurementsAux->covMatrix[measIdx].data()};
  }
  inline Acts::TrackIndexType size_impl() const { return m_trackStatesAux->size(); }
 
  ActsTrk::IndexType calibratedSize_impl(ActsTrk::IndexType istate) const;
  typename Acts::SourceLink getUncalibratedSourceLink_impl(ActsTrk::IndexType istate) const;
 
  const Acts::Surface* referenceSurface_impl(IndexType) const;
 
  void fillSurfaces(const Acts::TrackingGeometry* geo, const Acts::GeometryContext& geoContext );
  void moveSurfaces(const ActsTrk::MutableMultiTrajectory* mtj);
 
  void moveLinks(const ActsTrk::MutableMultiTrajectory* mtj);
 
  std::vector<Acts::HashedString> dynamicKeys_impl() const;
 
 private:
  const DataLink<xAOD::TrackStateAuxContainer> m_trackStatesAux;
  const DataLink<xAOD::TrackParametersAuxContainer> m_trackParametersAux;
  const DataLink<xAOD::TrackJacobianAuxContainer> m_trackJacobiansAux;
  const DataLink<xAOD::TrackMeasurementAuxContainer> m_trackMeasurementsAux;
  const DataLink<xAOD::TrackSurfaceAuxContainer> m_trackSurfacesAux;
  std::vector<ActsTrk::detail::Decoration> m_decorations;
 
  // TODO remove once tracking code switches to sourceLinks with EL
  std::vector<std::optional<Acts::SourceLink>> m_calibratedSourceLinks;
  // still need this to store SourceLinks with other payloads than
  // pointer to xAOD::UncalibratedMeasurement e.g. pointer to Trk::Measurements
  // when converting Trk::Tracks to Acts tracks.
  std::vector<std::optional<Acts::SourceLink>> m_uncalibratedSourceLinks;
 
  std::vector<StoredSurface> m_surfaces;
 
  xAOD::TrackStateContainer m_trackStatesIface;
};
 
 
template<typename IFACE, typename AUX>
std::unique_ptr<IFACE> makeInterfaceContainer(const AUX* aux) {
  auto interface = std::make_unique<IFACE>();
  for ( size_t i = 0, sz = aux->size(); i < sz; ++i) {
    interface->emplace_back( new std::remove_pointer_t<typename IFACE::value_type>() );
  }
  interface->setStore(aux);
  return interface;
}
 
 
}  // namespace ActsTrk
 
#include "MultiTrajectory.icc"
 
 
#include "AthenaKernel/CLASS_DEF.h"
CLASS_DEF( ActsTrk::MultiTrajectory , 51219308 , 1 )
 
// These two lines shouldn't be here, but necessary until we have a proper
// solution
#include "Acts/EventData/VectorTrackContainer.hpp"
CLASS_DEF(Acts::ConstVectorTrackContainer, 1074811884, 1)
 
#endif