CDCCKFDuplicateRemover.h

/**************************************************************************
 * 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.                  *
 **************************************************************************/
#pragma once
 
#include <tracking/trackFindingCDC/findlets/base/Findlet.h>
#include <tracking/ckf/cdc/entities/CDCCKFResult.h>
 
#include <tracking/trackFindingCDC/filters/base/ChooseableFilter.h>
#include <tracking/ckf/cdc/filters/paths/CDCPathFilterFactory.h>
 
#include <tracking/ckf/cdc/filters/pathPairs/CDCPathPairFilterFactory.h>
#include <tracking/trackFindingCDC/filters/base/ChooseableFilter.icc.h>
 
#include <ecl/dataobjects/ECLShower.h>
 
#include <Math/VectorUtil.h>
 
namespace Belle2 {
  class CDCCKFDuplicateRemover : public TrackFindingCDC::Findlet<CDCCKFResult> {
  public:
    CDCCKFDuplicateRemover()
    {
      addProcessingSignalListener(&m_filter_badTracks);
      addProcessingSignalListener(&m_filter_duplicateTrack);
      addProcessingSignalListener(&m_filter_duplicateSeed);
    }
 
    void exposeParameters(ModuleParamList* moduleParamList, const std::string& prefix) override
    {
      m_filter_badTracks.exposeParameters(moduleParamList, TrackFindingCDC::prefixed("badTracks", prefix));
      m_filter_duplicateTrack.exposeParameters(moduleParamList, TrackFindingCDC::prefixed("duplicateTrack", prefix));
      m_filter_duplicateSeed.exposeParameters(moduleParamList, TrackFindingCDC::prefixed("duplicateSeed", prefix));
 
      moduleParamList->addParameter(TrackFindingCDC::prefixed(prefix, "duplicateSeed_maxPhi"),
                                    duplicateSeed_maxPhi,
                                    "Seeds within this dPhi can be considered as duplicates (-1 to neglect)",
                                    duplicateSeed_maxPhi);
 
      moduleParamList->addParameter(TrackFindingCDC::prefixed(prefix, "duplicateSeed_maxTheta"),
                                    duplicateSeed_maxTheta,
                                    "Seeds within this dTheta can be considered as duplicates (-1 to neglect)",
                                    duplicateSeed_maxTheta);
    }
 
    void apply(std::vector<CDCCKFResult>& results) override
    {
      B2DEBUG(29, "CDCCKFDuplicateRemover: " << results.size() << " paths created (might be without any hits)");
 
      std::vector<CDCCKFResult> goodResults;
 
      // Additional filter (typically check if charge of reconstructed track is equal to charge of seed)
      TrackFindingCDC::Weight weight;
      std::unordered_map<double, CDCCKFResult> resultToWeightList;
      for (const auto& result : results) {
        weight = m_filter_badTracks(result);
        if (not std::isnan(weight)) {
          goodResults.push_back(result);
        }
      }
 
      int n_goodresults = goodResults.size();
 
      B2DEBUG(29, "CDCCKFDuplicateRemover: " << goodResults.size() << " paths created (after filtering)");
 
      if (n_goodresults > 1) {
        for (const auto& result : goodResults) {
          B2DEBUG(29, "charge = " << result.front().getSeed()->getChargeSeed() << "; "
                  << "theta = " << result.front().getSeed()->getPositionSeed().Theta() * 180. / M_PI << "; "
                  << (result.size() - 1) << " hits (" << result.at(1).getWireHit()->getWire().getICLayer() << "->" <<
                  result.back().getWireHit()->getWire().getICLayer() << "); "
                  << "r/z = " << result.front().getSeed()->getPositionSeed().Rho() << "; " << result.front().getSeed()->getPositionSeed().Z());
        }
      }
 
      // If both charge assumptions lead to a good track, only pick one to avoid duplicate tracks
      auto iter = goodResults.begin();
      while (iter < goodResults.end()) {
        auto iter2 = iter + 1;
        bool increaseIter = true;
        while (iter2 < goodResults.end()) {
          // find tracks from same seed
          if (iter2->front().getSeed()->getRelated<ECLShower>() == iter2->front().getSeed()->getRelated<ECLShower>()) {
            // let filter decide which one to keep
            bool selectFirst = m_filter_duplicateTrack(std::pair(&*iter, &*iter2)) > 0;
            if (selectFirst) {
              iter2 = goodResults.erase(iter2);
            } else {
              iter = goodResults.erase(iter);
              increaseIter = false;
              break;
            }
          } else {
            ++iter2;
          }
        }
        if (increaseIter) {
          ++iter;
        }
      }
 
      B2DEBUG(29, "CDCCKFDuplicateRemover: " << goodResults.size() << " paths created (after duplicates)");
 
      if (n_goodresults > 1) {
        for (const auto& result : goodResults) {
          B2DEBUG(29, "charge = " << result.front().getSeed()->getChargeSeed() << "; "
                  << "theta = " << result.front().getSeed()->getPositionSeed().Theta() * 180. / M_PI << "; "
                  << (result.size() - 1) << " hits (" << result.at(1).getWireHit()->getWire().getICLayer() << "->" <<
                  result.back().getWireHit()->getWire().getICLayer() << "); "
                  << "r/z = " << result.front().getSeed()->getPositionSeed().Rho() << "; " << result.front().getSeed()->getPositionSeed().Z());
        }
      }
 
      // Remove duplicate tracks from Bremsstrahlung
      // Be careful as this might also remove photon conversions (m_filter_duplicateSeed decides if both should be kept)
      iter = goodResults.begin();
      while (iter < goodResults.end()) {
        double phiClus = iter->front().getSeed()->getPositionSeed().Phi();
        double thetaClus = iter->front().getSeed()->getPositionSeed().Theta();
 
        auto iter2 = iter + 1;
        bool increaseIter = true;
        while (iter2 < goodResults.end()) {
          // find tracks from close-by seeds (use small strip in phi direction as expected from Bremsstrahlung)
          // to disregard this filter set duplicateSeed_maxPhi and duplicateSeed_maxTheta to negative values
          if (std::abs(ROOT::Math::VectorUtil::Phi_mpi_pi(iter2->front().getSeed()->getPositionSeed().Phi() - phiClus)) < duplicateSeed_maxPhi
              && std::abs(iter2->front().getSeed()->getPositionSeed().Theta() - thetaClus) < duplicateSeed_maxTheta) {
            // let filter decide which one to keep
            bool isDuplicate = m_filter_duplicateSeed(std::pair(&*iter, &*iter2)) > 0;
            if (! isDuplicate) {
              B2DEBUG(29, "Keeping both tracks");
              ++iter2;
            } else {
              B2DEBUG(29, "Duplicate hits found");
              bool selectFirst = m_filter_duplicateTrack(std::pair(&*iter, &*iter2)) > 0;
              if (selectFirst) {
                iter2 = goodResults.erase(iter2);
              } else {
                iter = goodResults.erase(iter);
                increaseIter = false;
                break;
              }
            }
          } else {
            ++iter2;
          }
        }
        if (increaseIter) {
          ++iter;
        }
      }
 
      results = goodResults;
 
      B2DEBUG(29, "CDCCKFDuplicateRemover: " << results.size() << " paths created (after merging)");
 
      if (n_goodresults > 1) {
        for (const auto& result : results) {
          B2DEBUG(29, "charge = " << result.front().getSeed()->getChargeSeed() << "; "
                  << "theta = " << result.front().getSeed()->getPositionSeed().Theta() * 180. / M_PI << "; "
                  << (result.size() - 1) << " hits (" << result.at(1).getWireHit()->getWire().getICLayer() << "->" <<
                  result.back().getWireHit()->getWire().getICLayer() << "); "
                  << "r/z = " << result.front().getSeed()->getPositionSeed().Rho() << "; " << result.front().getSeed()->getPositionSeed().Z());
        }
      }
    }
 
  private:
    TrackFindingCDC::ChooseableFilter<CDCPathFilterFactory> m_filter_badTracks;
    TrackFindingCDC::ChooseableFilter<CDCPathPairFilterFactory> m_filter_duplicateTrack;
    TrackFindingCDC::ChooseableFilter<CDCPathPairFilterFactory> m_filter_duplicateSeed;
 
    double duplicateSeed_maxPhi = 2.;
    double duplicateSeed_maxTheta = 0.1;
 
  };
}