CDCSegment2D.cc

/**************************************************************************
 * basf2 (Belle II Analysis Software Framework)                           *
 * Author: The Belle II Collaboration                                     *
 *                                                                        *
 * See git log for contributors and copyright holders.                    *
 * This file is licensed under LGPL-3.0, see LICENSE.md.                  *
 **************************************************************************/
#include <tracking/trackFindingCDC/eventdata/segments/CDCSegment2D.h>
 
#include <tracking/trackFindingCDC/eventdata/segments/CDCFacetSegment.h>
#include <tracking/trackFindingCDC/eventdata/segments/CDCTangentSegment.h>
 
#include <tracking/trackFindingCDC/eventdata/segments/CDCRLWireHitSegment.h>
#include <tracking/trackFindingCDC/eventdata/segments/CDCWireHitSegment.h>
#include <tracking/trackFindingCDC/eventdata/hits/CDCFacet.h>
#include <tracking/trackFindingCDC/eventdata/hits/CDCTangent.h>
#include <tracking/trackFindingCDC/eventdata/hits/CDCRecoHit2D.h>
#include <tracking/trackFindingCDC/eventdata/hits/CDCWireHit.h>
#include <tracking/trackFindingCDC/eventdata/trajectories/CDCTrajectory2D.h>
 
#include <tracking/trackFindingCDC/geometry/Vector2D.h>
 
#include <tracking/trackFindingCDC/ca/AutomatonCell.h>
 
#include <tracking/trackFindingCDC/numerics/ERightLeft.h>
 
#include <tracking/trackFindingCDC/utilities/WeightedRelation.h>
#include <tracking/trackFindingCDC/utilities/Relation.h>
#include <tracking/trackFindingCDC/utilities/Algorithms.h>
#include <tracking/trackFindingCDC/utilities/ReversedRange.h>
#include <tracking/trackFindingCDC/utilities/GetIterator.h>
 
#include <framework/logging/Logger.h>
 
#include <functional>
#include <algorithm>
#include <iterator>
 
#include <cassert>
#include <cstddef>
 
namespace Belle2 {
  namespace TrackFindingCDC {
    class CDCRLWireHit;
    class CDCWire;
  }
}
 
using namespace Belle2;
using namespace TrackFindingCDC;
 
namespace {
  void createTangentSegment(const CDCRLWireHitSegment& rlWireHitSegment,
                            CDCTangentSegment& tangentSegment)
  {
    size_t nRLWireHits = rlWireHitSegment.size();
    if (nRLWireHits < 2) return;
 
    tangentSegment.reserve(nRLWireHits - 1);
 
    // Make tangents from pairs of hits along the segment.
    transform_adjacent_pairs(rlWireHitSegment.begin(), rlWireHitSegment.end(),
                             back_inserter(tangentSegment),
                             [](const CDCRLWireHit & firstRLWireHit,
    const CDCRLWireHit & secondRLWireHit) {
      return CDCTangent(firstRLWireHit, secondRLWireHit);
    });
 
    if (tangentSegment.size() + 1 != rlWireHitSegment.size()) {
      B2ERROR("Wrong number of tangents created.");
    }
 
  }
 
  template<class ATangentRange>
  CDCSegment2D condenseTangentSegment(const ATangentRange& tangentSegment)
  {
    using TangentIt = GetIterator<const ATangentRange&>;
    TangentIt tangentIt{tangentSegment.begin()};
    TangentIt endTangentIt{tangentSegment.end()};
    int nTangents = std::distance(tangentIt, endTangentIt);
 
    CDCSegment2D result;
    result.reserve(nTangents + 1);
 
    if (nTangents == 0) {
      //pass
    } else if (nTangents == 1) {
      // Only one tangent no averaging necesssary
      const CDCTangent& tangent = *tangentIt;
      result.push_back(tangent.getFromRecoHit2D());
      result.push_back(tangent.getToRecoHit2D());
 
    } else { // nTangents > 2
      TangentIt firstTangentIt = tangentIt++;
      TangentIt secondTangentIt = tangentIt++;
 
      {
        const CDCTangent& firstTangent = *firstTangentIt;
        result.push_back(firstTangent.getFromRecoHit2D());
      }
 
      while (tangentIt != endTangentIt) {
 
        firstTangentIt = secondTangentIt; // tangentSegment[iTangent];
        secondTangentIt = tangentIt++; // tangentSegment[iTangent+1];
 
        const CDCTangent& firstTangent = *firstTangentIt;
        const CDCTangent& secondTangent = *secondTangentIt;
 
        result.push_back(CDCRecoHit2D::average(firstTangent.getToRecoHit2D(),
                                               secondTangent.getFromRecoHit2D()));
      }
      {
        const CDCTangent& secondTangent = *secondTangentIt;
        result.push_back(secondTangent.getToRecoHit2D());
      }
    }
 
    result.receiveISuperCluster();
    return result;
  }
 
  template<class AFacetRange>
  CDCSegment2D condenseFacetSegment(const AFacetRange& facetSegment)
  {
    using FacetIt = GetIterator<const AFacetRange&>;
    FacetIt facetIt = facetSegment.begin();
    FacetIt endFacetIt = facetSegment.end();
    int nFacets = std::distance(facetIt, endFacetIt);
 
    CDCSegment2D result;
    result.reserve(nFacets + 2);
 
    if (nFacets == 0) {
      //pass
    } else if (nFacets == 1) {
      FacetIt onlyFacetIt = facetIt;
      const CDCFacet& onlyFacet = *onlyFacetIt;
      result.push_back(onlyFacet.getStartRecoHit2D());
      result.push_back(onlyFacet.getMiddleRecoHit2D());
      result.push_back(onlyFacet.getEndRecoHit2D());
 
    } else if (nFacets == 2) {
      FacetIt firstFacetIt = facetIt++;
      FacetIt secondFacetIt = facetIt;
 
      const CDCFacet& firstFacet = *firstFacetIt;
      const CDCFacet& secondFacet = *secondFacetIt;
 
      result.push_back(firstFacet.getStartRecoHit2D());
      result.push_back(CDCRecoHit2D::average(secondFacet.getStartRecoHit2D() ,
                                             firstFacet.getMiddleRecoHit2D()));
 
      result.push_back(CDCRecoHit2D::average(secondFacet.getMiddleRecoHit2D(),
                                             firstFacet.getEndRecoHit2D()));
 
      result.push_back(secondFacet.getEndRecoHit2D());
 
    } else { // nFacets > 2
      FacetIt firstFacetIt = facetIt++; // facetSegment[0];
      FacetIt secondFacetIt = facetIt++; // facetSegment[1];
      FacetIt thirdFacetIt = facetIt++;  // facetSegment[2];
 
      {
        const CDCFacet& firstFacet = *firstFacetIt;
        const CDCFacet& secondFacet = *secondFacetIt;
        const CDCFacet& thirdFacet = *thirdFacetIt;
 
        result.push_back(firstFacet.getStartRecoHit2D());
 
        result.push_back(CDCRecoHit2D::average(firstFacet.getMiddleRecoHit2D(),
                                               secondFacet.getStartRecoHit2D()));
 
        result.push_back(CDCRecoHit2D::average(firstFacet.getEndRecoHit2D(),
                                               secondFacet.getMiddleRecoHit2D(),
                                               thirdFacet.getStartRecoHit2D()));
      }
 
      while (facetIt != endFacetIt) {
        firstFacetIt = secondFacetIt; // facetSegment[iFacet];
        secondFacetIt = thirdFacetIt; // facetSegment[iFacet+1];
        thirdFacetIt = facetIt++; // facetSegment[iFacet+2];
 
        const CDCFacet& firstFacet = *firstFacetIt;
        const CDCFacet& secondFacet = *secondFacetIt;
        const CDCFacet& thirdFacet = *thirdFacetIt;
 
        result.push_back(CDCRecoHit2D::average(firstFacet.getEndRecoHit2D(),
                                               secondFacet.getMiddleRecoHit2D(),
                                               thirdFacet.getStartRecoHit2D()));
      }
      {
        const CDCFacet& secondFacet = *secondFacetIt;
        const CDCFacet& thirdFacet = *thirdFacetIt;
 
        result.push_back(CDCRecoHit2D::average(secondFacet.getEndRecoHit2D(),
                                               thirdFacet.getMiddleRecoHit2D()));
 
        result.push_back(thirdFacet.getEndRecoHit2D());
      }
    }
 
    result.receiveISuperCluster();
    return result;
  }
 
}
 
CDCSegment2D CDCSegment2D::condense(const CDCTangentSegment& tangentSegment)
{
  const std::vector<CDCTangent>& tangents = tangentSegment;
  CDCSegment2D segment2D = ::condenseTangentSegment(tangents);
  segment2D.setTrajectory2D(tangentSegment.getTrajectory2D());
  segment2D.receiveISuperCluster();
  segment2D.setAliasScore(tangentSegment.getAliasScore());
  return segment2D;
}
 
CDCSegment2D CDCSegment2D::condense(const std::vector<const CDCTangent* >& tangentPath)
{
  std::vector<std::reference_wrapper<const CDCTangent> > tangents;
  tangents.reserve(tangentPath.size());
  for (const CDCTangent* tangent : tangentPath) {
    tangents.push_back(std::ref(*tangent));
  }
 
  return ::condenseTangentSegment(tangents);
}
 
CDCSegment2D CDCSegment2D::condense(const CDCFacetSegment& facetSegment)
{
  const std::vector<CDCFacet>& facets = facetSegment;
  CDCSegment2D segment2D = ::condenseFacetSegment(facets);
  segment2D.setTrajectory2D(facetSegment.getTrajectory2D());
  segment2D.receiveISuperCluster();
  segment2D.setAliasScore(facetSegment.getAliasScore());
  return segment2D;
}
 
CDCSegment2D CDCSegment2D::condense(const std::vector<const CDCFacet* >& facetPath)
{
  std::vector<std::reference_wrapper<const CDCFacet> > facets;
  facets.reserve(facetPath.size());
  for (const CDCFacet* facet : facetPath) {
    facets.push_back(std::ref(*facet));
  }
 
  return ::condenseFacetSegment(facets);
}
 
CDCSegment2D CDCSegment2D::condense(const std::vector<const CDCSegment2D*>& segmentPath)
{
  CDCSegment2D result;
  double aliasScore = 0;
  for (const CDCSegment2D* ptrSegment2D : segmentPath) {
    assert(ptrSegment2D);
    const CDCSegment2D& segment2D = *ptrSegment2D;
    if (result.empty()) {
      result = segment2D;
    } else {
      for (const CDCRecoHit2D& recoHit2D : segment2D) {
        result.push_back(recoHit2D);
      }
    }
    aliasScore = aliasScore + segment2D.getAliasScore();
  }
  result.receiveISuperCluster();
  result.setAliasScore(aliasScore);
  return result;
}
 
CDCSegment2D CDCSegment2D::reconstructUsingTangents(const CDCRLWireHitSegment& rlWireHitSegment)
{
  if (rlWireHitSegment.size() == 1) {
    CDCSegment2D segment2D;
    Vector2D zeroDisp2D(0.0, 0.0);
    segment2D.emplace_back(rlWireHitSegment.front(), zeroDisp2D);
    segment2D.setTrajectory2D(rlWireHitSegment.getTrajectory2D());
    segment2D.receiveISuperCluster();
    segment2D.setAliasScore(rlWireHitSegment.getAliasScore());
    return segment2D;
  } else {
    CDCTangentSegment tangentSegment;
    createTangentSegment(rlWireHitSegment, tangentSegment);
    tangentSegment.setTrajectory2D(rlWireHitSegment.getTrajectory2D());
    tangentSegment.setAliasScore(rlWireHitSegment.getAliasScore());
    return condense(tangentSegment);
  }
}
 
CDCSegment2D CDCSegment2D::reconstructUsingFacets(const CDCRLWireHitSegment& rlWireHitSegment)
{
  if (rlWireHitSegment.size() < 3) {
    return reconstructUsingTangents(rlWireHitSegment);
  } else {
    CDCFacetSegment facetSegment = CDCFacetSegment::create(rlWireHitSegment);
    return condense(facetSegment);
  }
}
 
Relation<const CDCSegment2D> CDCSegment2D::makeRelation(const CDCSegment2D* segment) const
{
  return {this, segment};
}
 
WeightedRelation<const CDCSegment2D> CDCSegment2D::makeWeightedRelation(double weight, const CDCSegment2D* segment) const
{
  return {this, weight, segment};
}
 
bool CDCSegment2D::operator<(const CDCSegment2D& segment2D) const
{
  return (this->getISuperLayer() < segment2D.getISuperLayer()) or
         (not(segment2D.getISuperLayer() < this->getISuperLayer()) and
          this->getISuperCluster() < segment2D.getISuperCluster());
}
 
std::vector<const CDCWire*> CDCSegment2D::getWireSegment() const
{
  std::vector<const CDCWire*> wireSegment;
  for (const CDCRecoHit2D& recoHit2D : *this) {
    wireSegment.push_back(&(recoHit2D.getWire()));
  }
  return wireSegment;
}
 
CDCWireHitSegment CDCSegment2D::getWireHitSegment() const
{
  CDCWireHitSegment wireHitSegment;
  for (const CDCRecoHit2D& recoHit2D : *this) {
    wireHitSegment.push_back(&(recoHit2D.getWireHit()));
  }
  wireHitSegment.setTrajectory2D(getTrajectory2D());
  wireHitSegment.setAliasScore(getAliasScore());
  return wireHitSegment;
}
 
CDCSegment2D CDCSegment2D::getAlias() const
{
  CDCSegment2D segment;
  for (const CDCRecoHit2D& recoHit2D : *this) {
    segment.push_back(recoHit2D.getAlias());
  }
  segment.setISuperCluster(getISuperCluster());
  segment.setAliasScore(getAliasScore());
  return segment;
}
 
int CDCSegment2D::getNRLSwitches() const
{
  ERightLeft rlInfo = ERightLeft::c_Invalid;
  int nRLSwitches = -1;
  for (const CDCRecoHit2D& recoHit2D : *this) {
    if (rlInfo != recoHit2D.getRLInfo()) {
      rlInfo = recoHit2D.getRLInfo();
      ++nRLSwitches;
    }
  }
  return nRLSwitches;
}
 
double CDCSegment2D::getRLAsymmetry() const
{
  int rlSum = 0;
  for (const CDCRecoHit2D& recoHit2D : *this) {
    if (isValid(recoHit2D.getRLInfo())) {
      rlSum += recoHit2D.getRLInfo();
    }
  }
  return static_cast<double>(rlSum) / size();
}
 
CDCRLWireHitSegment CDCSegment2D::getRLWireHitSegment() const
{
  CDCRLWireHitSegment rlWireHitSegment;
  for (const CDCRecoHit2D& recoHit2D : *this) {
    rlWireHitSegment.push_back(recoHit2D.getRLWireHit());
  }
  rlWireHitSegment.setTrajectory2D(getTrajectory2D());
  rlWireHitSegment.setAliasScore(getAliasScore());
  return rlWireHitSegment;
}
 
CDCSegment2D CDCSegment2D::reversed() const
{
  CDCSegment2D reverseSegment;
  reverseSegment.reserve(size());
  for (const CDCRecoHit2D& recohit : reversedRange(*this)) {
    reverseSegment.push_back(recohit.reversed());
  }
 
  reverseSegment.setTrajectory2D(getTrajectory2D().reversed());
  reverseSegment.m_automatonCell = m_automatonCell;
  reverseSegment.setISuperCluster(getISuperCluster());
  reverseSegment.setAliasScore(getAliasScore());
  return reverseSegment;
}
 
void CDCSegment2D::reverse()
{
  // Reverse the trajectory
  getTrajectory2D().reverse();
 
  // Reverse the left right passage hypotheses
  for (CDCRecoHit2D& recoHit2D : *this) {
    recoHit2D.reverse();
  }
  // Reverse the arrangement of hits.
  std::reverse(begin(), end());
}
 
void CDCSegment2D::unsetAndForwardMaskedFlag(bool toHits) const
{
  getAutomatonCell().unsetMaskedFlag();
  if (not toHits) return;
  for (const CDCRecoHit2D& recoHit2D : *this) {
    const CDCWireHit& wireHit = recoHit2D.getWireHit();
    wireHit.getAutomatonCell().unsetMaskedFlag();
  }
}
 
void CDCSegment2D::setAndForwardMaskedFlag(bool toHits) const
{
  getAutomatonCell().setMaskedFlag();
  if (not toHits) return;
  for (const CDCRecoHit2D& recoHit2D : *this) {
    const CDCWireHit& wireHit = recoHit2D.getWireHit();
    wireHit.getAutomatonCell().setMaskedFlag();
  }
}
 
void CDCSegment2D::receiveMaskedFlag(bool fromHits) const
{
  if (not fromHits) return;
  for (const CDCRecoHit2D& recoHit2D : *this) {
    const CDCWireHit& wireHit = recoHit2D.getWireHit();
    if (wireHit.getAutomatonCell().hasMaskedFlag()) {
      getAutomatonCell().setMaskedFlag();
      return;
    }
  }
}
 
bool CDCSegment2D::isFullyTaken(unsigned int maxNotTaken) const
{
  unsigned int notTakenCounter = 0;
  for (const CDCRecoHit2D& recoHit : *this) {
    if (not recoHit.getWireHit().getAutomatonCell().hasTakenFlag()) {
      notTakenCounter++;
      if (notTakenCounter > maxNotTaken) {
        return false;
      }
    }
  }
 
  return true;
}
 
void CDCSegment2D::receiveISuperCluster() const
{
  auto getISuperClusterOfHit = [](const CDCRecoHit2D & recoHit2d) -> int {
    return recoHit2d.getWireHit().getISuperCluster();
  };
  int iSuperCluster = common(*this, getISuperClusterOfHit, -1);
  setISuperCluster(iSuperCluster);
}