CDCTrigger2DFinderModule.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 <trg/cdc/modules/houghtracking/CDCTrigger2DFinderModule.h>
 
#include <cdc/geometry/CDCGeometryPar.h>
#include <framework/logging/Logger.h>
#include <framework/gearbox/Const.h>
 
#include <cmath>
#include <algorithm>
#include <iterator>
 
/* defines */
#define CDC_SUPER_LAYERS 9
 
using namespace std;
using namespace Belle2;
using namespace Belle2::CDC;
 
//-----------------------------------------------------------------
//                 Register the Module
//-----------------------------------------------------------------
REG_MODULE(CDCTrigger2DFinder);
 
//-----------------------------------------------------------------
//                 Implementation
//-----------------------------------------------------------------
 
CDCTrigger2DFinderModule::CDCTrigger2DFinderModule() : Module()
{
  //Set module properties
  setDescription("Hough tracking algorithm for CDC trigger.");
  setPropertyFlags(c_ParallelProcessingCertified);
 
  // Define module parameters
  addParam("hitCollectionName", m_hitCollectionName,
           "Name of the input StoreArray of CDCTriggerSegmentHits.",
           string(""));
  addParam("outputCollectionName", m_outputCollectionName,
           "Name of the StoreArray holding the tracks found in the Hough tracking.",
           string("TRGCDC2DFinderTracks"));
  addParam("clusterCollectionName", m_clusterCollectionName,
           "Name of the StoreArray holding the clusters formed in the Hough plane.",
           string(""));
  addParam("nCellsPhi", m_nCellsPhi,
           "Number of Hough cells in phi (limits: [-180, 180]). Must be an even number.",
           (unsigned)(160));
  addParam("nCellsR", m_nCellsR,
           "Number of Hough cells in 1/r. Must be an even number.",
           (unsigned)(34));
  addParam("minPt", m_minPt,
           "Minimum Pt [GeV]. "
           "Hough plane limits in 1/r are [-1/r(minPt), 1/r(minPt)]", (double)(0.3));
  addParam("shiftPt", m_shiftPt,
           "Shift the Hough plane by 1/4 cell size in 1/r to avoid "
           "curvature 0 tracks (<0: shift in negative direction, "
           "0: no shift, >0: shift in positive direction).", 0);
 
  addParam("minHits", m_minHits,
           "Minimum hits from different super layers required in a peak cell.",
           (unsigned)(4));
  addParam("minHitsShort", m_minHitsShort,
           "Minimum hits required required in a peak cell for a short track"
           " (must be in the first minHitsShort super layers).",
           (unsigned)(4));
  addParam("minCells", m_minCells,
           "Peaks with less than minCells connected cells are ignored.",
           (unsigned)(2));
  addParam("onlyLocalMax", m_onlyLocalMax,
           "Switch to remove cells connected to a cell with higher super layer count.",
           false);
  addParam("connect", m_connect,
           "Definition for connected cells. 4: direct (left/right/top/bottom), "
           "6: direct + 2 diagonal (top right/bottom left), "
           "8: direct + all diagonal (top right/top left/bottom right/bottom left)",
           (unsigned)(6));
  addParam("ignore2ndPriority", m_ignore2nd,
           "Switch to skip second priority hits.", false);
  addParam("usePriorityPosition", m_usePriority,
           "If true, use wire position of priority cell in track segment, "
           "otherwise use wire position of center cell.", true);
  addParam("requireSL0", m_requireSL0,
           "Switch to check separately for a hit in the innermost superlayer.", false);
  addParam("storeHoughPlane", m_storePlane,
           "Switch for saving Hough plane as TMatrix in DataStore. "
           "0: don't store anything, 1: store only peaks, 2: store full plane "
           "(will increase runtime).", (unsigned)(0));
  addParam("clusterPattern", m_clusterPattern,
           "use nested pattern algorithm to find clusters", true);
  addParam("clusterSizeX", m_clusterSizeX,
           "maximum number of 2 x 2 squares in cluster for pattern algorithm",
           (unsigned)(3));
  addParam("clusterSizeY", m_clusterSizeY,
           "maximum number of 2 x 2 squares in cluster for pattern algorithm",
           (unsigned)(3));
  addParam("hitRelationsFromCorners", m_hitRelationsFromCorners,
           "Switch for creating relations to hits in the pattern algorithm. "
           "If true, create relations from cluster corners, otherwise "
           "from estimated cluster center (might not have relations).", false);
 
  addParam("testFilename", m_testFilename,
           "If not empty, a file with input (hits) and output (tracks) "
           "for each event is written (for firmware debugging).", string(""));
 
  addParam("suppressClone", m_suppressClone,
           "Switch to send only the first found track and suppress the "
           "subsequent clones.", false);
 
  addParam("usehitpattern", m_usehitpattern,
           "Switch to use hit pattern inside TSF ", false);
 
  addParam("useadc", m_useadc,
           "Switch to use ADC. Can be used with usehitpattern enabled. ", false);
}
 
void
CDCTrigger2DFinderModule::initialize()
{
  m_segmentHits.isRequired(m_hitCollectionName);
  m_tracks.registerInDataStore(m_outputCollectionName);
  m_clusters.registerInDataStore(m_clusterCollectionName);
 
  m_tracks.registerRelationTo(m_segmentHits);
  m_tracks.registerRelationTo(m_clusters);
 
  if (m_storePlane > 0) m_houghPlane.registerInDataStore("HoughPlane");
 
  const CDCGeometryPar& cdc = CDCGeometryPar::Instance();
  int layerId = 3;
  int nTS = 0;
  for (int iSL = 0; iSL < 9; ++iSL) {
    TSoffset[iSL] = nTS;
    nTS += cdc.nWiresInLayer(layerId);
    TSoffset[iSL + 1] = nTS;
    if (!m_usehitpattern) {
      for (int priority = 0; priority < 2; ++ priority) {
        radius[iSL][priority] = cdc.senseWireR(layerId + priority);
      }
    } else {
      for (int priority = 0; priority < 5; ++ priority) {
        if (iSL == 0) radius[iSL][priority] = cdc.senseWireR(layerId + priority);
        else       radius[iSL][priority] = cdc.senseWireR(layerId + priority - 2);
      }
    }
    layerId += (iSL > 0 ? 6 : 7);
  }
 
  if (m_testFilename != "") {
    testFile.open(m_testFilename);
  }
 
  if (m_suppressClone) {
    B2INFO("2D finder will exit with the first track candidate in time.");
  }
}
 
void
CDCTrigger2DFinderModule::event()
{
  /* Clean hits */
  hitMap.clear();
  houghCand.clear();
 
  /* set default return value */
  setReturnValue(true);
 
  if (m_testFilename != "") {
    testFile << StoreObjPtr<EventMetaData>()->getEvent() << " "
             << m_segmentHits.getEntries() << endl;
  }
 
  if (m_segmentHits.getEntries() == 0) {
    //B2WARNING("CDCTracking: tsHitsCollection is empty!");
    return;
  }
 
  /* get CDCHits coordinates in conformal space */
  for (int iHit = 0; iHit < m_segmentHits.getEntries(); iHit++) {
    unsigned short iSL = m_segmentHits[iHit]->getISuperLayer();
    if (m_testFilename != "") {
      testFile << iSL << " " << m_segmentHits[iHit]->getSegmentID() - TSoffset[iSL] << " "
               << m_segmentHits[iHit]->getPriorityPosition() << endl;
    }
    if (iSL % 2) continue;
    if (m_ignore2nd && m_segmentHits[iHit]->getPriorityPosition() < 3) continue;
 
    if (m_usehitpattern) {
      unsigned hitpattern;
      if (m_useadc) hitpattern = m_segmentHits[iHit]->gethitpattern_adc();
      else          hitpattern = m_segmentHits[iHit]->gethitpattern();
      int nhitpattern = 0;
      if (iSL == 0)nhitpattern = 15;
      else         nhitpattern = 11;
      for (int i = 0; i < nhitpattern; i++) {
        if ((hitpattern & (1 << i)) != 0) {
          double phi = m_segmentHits[iHit]->getSegmentID() - TSoffset[iSL];
          if (iSL != 0 && i == 0)  phi = phi - 1;
          else if (iSL != 0 && i == 1)  phi = phi + 0;
          else if (iSL != 0 && i == 2)  phi = phi + 1;
          else if (iSL != 0 && i == 3)  phi = phi - 0.5;
          else if (iSL != 0 && i == 4)  phi = phi + 0.5;
          else if (iSL != 0 && i == 5)  phi = phi + 0;
          else if (iSL != 0 && i == 6)  phi = phi - 0.5;
          else if (iSL != 0 && i == 7)  phi = phi + 0.5;
          else if (iSL != 0 && i == 8)  phi = phi - 1;
          else if (iSL != 0 && i == 9)  phi = phi + 0;
          else if (iSL != 0 && i == 10) phi = phi + 1;
          else if (iSL == 0 && i == 0)  phi = phi + 0;
          else if (iSL == 0 && i == 1)  phi = phi - 0.5;
          else if (iSL == 0 && i == 2)  phi = phi + 0.5;
          else if (iSL == 0 && i == 3)  phi = phi - 1;
          else if (iSL == 0 && i == 4)  phi = phi + 0;
          else if (iSL == 0 && i == 5)  phi = phi + 1;
          else if (iSL == 0 && i == 6)  phi = phi - 1.5;
          else if (iSL == 0 && i == 7)  phi = phi - 0.5;
          else if (iSL == 0 && i == 8)  phi = phi + 0.5;
          else if (iSL == 0 && i == 9)  phi = phi + 1.5;
          else if (iSL == 0 && i == 10) phi = phi - 2;
          else if (iSL == 0 && i == 11) phi = phi - 1;
          else if (iSL == 0 && i == 12) phi = phi + 0;
          else if (iSL == 0 && i == 13) phi = phi + 1;
          else if (iSL == 0 && i == 14) phi = phi + 2;
          phi = phi * 2. * M_PI / (TSoffset[iSL + 1] - TSoffset[iSL]);
          int iLayer = 0;
          if (iSL != 0 && i == 0)   iLayer = 0;
          else if (iSL != 0 && i == 1)   iLayer = 0;
          else if (iSL != 0 && i == 2)   iLayer = 0;
          else if (iSL != 0 && i == 3)   iLayer = 1;
          else if (iSL != 0 && i == 4)   iLayer = 1;
          else if (iSL != 0 && i == 5)   iLayer = 2;
          else if (iSL != 0 && i == 6)   iLayer = 3;
          else if (iSL != 0 && i == 7)   iLayer = 3;
          else if (iSL != 0 && i == 8)   iLayer = 4;
          else if (iSL != 0 && i == 9)   iLayer = 4;
          else if (iSL != 0 && i == 10)  iLayer = 4;
          else if (iSL == 0 && i == 0)   iLayer = 0;
          else if (iSL == 0 && i == 1)   iLayer = 1;
          else if (iSL == 0 && i == 2)   iLayer = 1;
          else if (iSL == 0 && i == 3)   iLayer = 2;
          else if (iSL == 0 && i == 4)   iLayer = 2;
          else if (iSL == 0 && i == 5)   iLayer = 2;
          else if (iSL == 0 && i == 6)   iLayer = 3;
          else if (iSL == 0 && i == 7)   iLayer = 3;
          else if (iSL == 0 && i == 8)   iLayer = 3;
          else if (iSL == 0 && i == 9)   iLayer = 3;
          else if (iSL == 0 && i == 10)  iLayer = 4;
          else if (iSL == 0 && i == 11)  iLayer = 4;
          else if (iSL == 0 && i == 12)  iLayer = 4;
          else if (iSL == 0 && i == 13)  iLayer = 4;
          else if (iSL == 0 && i == 14)  iLayer = 4;
 
          double r = radius[iSL][iLayer];
          ROOT::Math::XYVector pos(cos(phi) / r, sin(phi) / r);
          hitMap.insert(std::make_pair(iHit * 15 + i, std::make_pair(iSL * 5 + iLayer, pos)));
        }
      }
    } else {
      double phi = m_segmentHits[iHit]->getSegmentID() - TSoffset[iSL];
      if (m_usePriority) {
        phi += 0.5 * (((m_segmentHits[iHit]->getPriorityPosition() >> 1) & 1)
                      - (m_segmentHits[iHit]->getPriorityPosition() & 1));
      }
      phi = phi * 2. * M_PI / (TSoffset[iSL + 1] - TSoffset[iSL]);
      double r = radius[iSL][int(m_usePriority &&
                                 m_segmentHits[iHit]->getPriorityPosition() < 3)];
      ROOT::Math::XYVector pos(cos(phi) / r, sin(phi) / r);
      hitMap.insert(std::make_pair(iHit, std::make_pair(iSL, pos)));
    }
  }
 
  /* Extent the Hough plane such that the cell number is a power of 2 (same for x and y).
   * This is for the fast peak finder, which divides the Hough plane in half in each step.
   * Peaks found outside of the actual limits are ignored. */
  maxIterations = ceil(log2(max(m_nCellsPhi, m_nCellsR))) - 1;
  nCells = pow(2, maxIterations + 1);
  /* limits in phi: [-pi, pi] + extra cells */
  double rectX = M_PI * nCells / m_nCellsPhi;
  /* limits in R: [-R(minPt), R(minPt)] + extra cells + shift */
  maxR = 0.5 * Const::speedOfLight * 1.5e-4 / m_minPt;
  double rectY = maxR * nCells / m_nCellsR;
  shiftR = 0;
  if (m_shiftPt < 0) {
    shiftR = -maxR / 2. / m_nCellsR;
  } else if (m_shiftPt > 0) {
    shiftR = maxR / 2. / m_nCellsR;
  }
 
  B2DEBUG(50, "extending Hough plane to " << maxIterations << " iterations, "
          << nCells << " cells: phi in ["
          << -rectX * 180. / M_PI << ", " << rectX * 180. / M_PI
          << "] deg, 1/r in [" << -rectY + shiftR << ", " << rectY + shiftR << "] /cm");
 
  /* prepare matrix for storing the Hough plane */
  if (m_storePlane > 0) {
    m_houghPlane.create();
    m_houghPlane->ResizeTo(m_nCellsPhi, m_nCellsR);
  }
 
  // hit map containing only the early hits
  cdcMap fastHitMap;
  if (m_suppressClone && !hitMap.empty()) {
    // find the first track candidates in Hough plane
    // only for z0 resolution study with single-track events
    // This will surely fail with multi-track ones,
    // in which case we really need tick-by-tick simulation for all hits.
 
    typedef pair<int, cdcPair> cdcHitPair;
    // sequential hit map, ordered by TS found time
    typedef vector<cdcHitPair> cdcSeqMap;
    cdcSeqMap seqHitMap;
    // copy hit map to sequential hit map and sort it by TS found time
    for (auto hit : hitMap) {
      seqHitMap.push_back(hit);
    }
    sort(seqHitMap.begin(), seqHitMap.end(), [this](cdcHitPair i, cdcHitPair j) {
      return m_segmentHits[i.first]->foundTime() < m_segmentHits[j.first]->foundTime();
    });
    auto seqHitItr = seqHitMap.begin();
    /* layer filter */
    vector<bool> layerHit(CDC_SUPER_LAYERS, false);
    // data clock cycle in unit of 2ns
    short period = 16;
    short firstTick = m_segmentHits[(*seqHitMap.begin()).first]->foundTime() / period + 1;
    short lastTick = m_segmentHits[(*(seqHitMap.end() - 1)).first]->foundTime() / period + 1;
    // add TS hits in every clock cycle until a track candidate is found
    for (auto tick = firstTick * period; tick < lastTick * period; tick += period) {
      int nHitInCycle = 0;
      for (auto itr = seqHitItr; itr < seqHitMap.end(); ++itr) {
        cdcHitPair currentHit = *itr;
        // start from the first hit over SL threshold
        if (count(layerHit.begin(), layerHit.end(), true) >= m_minHits &&
            m_segmentHits[currentHit.first]->foundTime() > tick) {
          break;
        }
        nHitInCycle++;
        layerHit[m_segmentHits[currentHit.first]->getISuperLayer()] = true;
      }
      copy_n(seqHitItr, nHitInCycle, inserter(fastHitMap, fastHitMap.end()));
      fastInterceptFinder(fastHitMap, -rectX, rectX, -rectY + shiftR, rectY + shiftR, 0, 0, 0);
      B2DEBUG(20, "at tick " << tick << ", number of candidates: " << houghCand.size());
      if (!houghCand.empty()) {
        B2DEBUG(10, "found a track at clock " << tick << " with "
                << fastHitMap.size() << "hits");
        break;
      }
      advance(seqHitItr, nHitInCycle);
    }
  } else {
    /* find track candidates in Hough plane using all TS hits */
    fastInterceptFinder(hitMap, -rectX, rectX, -rectY + shiftR, rectY + shiftR, 0, 0, 0);
    if (!houghCand.empty()) {
      B2DEBUG(10, "found a track with " << hitMap.size() << "hits");
    }
  }
 
  /* merge track candidates */
  if (m_clusterPattern)
    patternClustering(fastHitMap);
  else
    connectedRegions();
 
  if (m_testFilename != "") {
    testFile << m_tracks.getEntries() << endl;
    for (int i = 0; i < m_tracks.getEntries(); ++i) {
      float ix = (m_tracks[i]->getPhi0() - M_PI_4) * m_nCellsPhi / 2. / M_PI - 0.5;
      float iy = (m_tracks[i]->getOmega() / 2. + maxR - shiftR) * m_nCellsR / 2. / maxR - 0.5;
      testFile << round(2 * ix) / 2. << " " << round(2 * iy) / 2. << " "
               << m_tracks[i]->getChargeSign() << endl;
      RelationVector<CDCTriggerSegmentHit> hits =
        m_tracks[i]->getRelationsTo<CDCTriggerSegmentHit>(m_hitCollectionName);
      testFile << hits.size() << endl;
      for (unsigned ihit = 0; ihit < hits.size(); ++ihit) {
        unsigned short iSL = hits[ihit]->getISuperLayer();
        testFile << iSL << " " << hits[ihit]->getSegmentID() - TSoffset[iSL] << " "
                 << hits[ihit]->getPriorityPosition() << " "
                 << hits.weight(ihit) << endl;
      }
    }
  }
}
 
void
CDCTrigger2DFinderModule::terminate()
{
  if (m_testFilename != "") testFile.close();
}