SpacePointHelperFunctions.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 <utility>
#include <vector>
 
#include <svd/calibration/SVDHitTimeSelection.h>
#include <svd/calibration/SVDNoiseCalibrations.h>
#include <svd/dataobjects/SVDCluster.h>
#include <svd/dataobjects/SVDShaperDigit.h>
#include <svd/dbobjects/SVDSpacePointSNRFractionSelector.h>
#include <svd/reconstruction/SVDMaxSumAlgorithm.h>
 
#include <framework/datastore/RelationArray.h>
#include <framework/datastore/StoreArray.h>
#include <framework/datastore/StoreObjPtr.h>
#include <framework/database/DBObjPtr.h>
#include <framework/utilities/MathHelpers.h>
#include <mdst/dataobjects/EventLevelTrackingInfo.h>
 
#include <vxd/dataobjects/VxdID.h>
 
#include <unordered_map>
 
#include <TH2.h>
#include <math.h>
#include <TFile.h>
 
namespace Belle2 {
 

  struct ClustersOnSensor {
 
  public:

    inline void addCluster(const SVDCluster* entry, int index)
    {
      vxdID = entry->getSensorID();
      if (entry->isUCluster() == true) {
        clustersU.push_back(entry);
        indicesU.push_back(index);
        return;
      }
      clustersV.push_back(entry);
      indicesV.push_back(index);
    }

    VxdID vxdID;

    std::vector<const SVDCluster*> clustersU;

    std::vector<const SVDCluster*> clustersV;

    std::vector<int> indicesU;

    std::vector<int> indicesV;
 
  };

  template <class SpacePointType> void provideSVDClusterSingles(const StoreArray<SVDCluster>& svdClusters,
      StoreArray<SpacePointType>& spacePoints)
  {
    // RelationArray is much cheaper than addRelationTo
    RelationArray spacePointsToClusters(spacePoints, svdClusters);
    for (unsigned int i = 0; i < uint(svdClusters.getEntries()); ++i) {
      const SVDCluster* currentCluster = svdClusters[i];
      std::vector<const SVDCluster*> currentClusterCombi = { currentCluster };
      const int spacePointIndex = spacePoints.getEntries();
      spacePoints.appendNew(currentClusterCombi);
      spacePointsToClusters.add(spacePointIndex, i);
    }
  }
 
 

  inline void storeInputVectorFromSingleCluster(const SVDCluster* cls,
                                                std::vector<float>& inputVector,
                                                const SVDNoiseCalibrations& noiseCal)
  {
    inputVector.clear();
    inputVector.resize(3, 0.0);
 
    auto shaperDigits = cls->getRelationsTo<SVDShaperDigit>();
    float noise = 0;
    for (auto iSD : shaperDigits) {
      auto samples = iSD.getSamples();
      std::vector<float> selectedSamples;
      if (samples.size() == 6) {
        Belle2::SVD::SVDMaxSumAlgorithm maxSum(samples);
        auto maxSamples = maxSum.getSelectedSamples();
        selectedSamples.assign(maxSamples.begin(), maxSamples.end());
      } else {
        selectedSamples.assign(samples.begin(), samples.end());
      }
      if (selectedSamples.size() < 3) continue;
 
      inputVector[0] += selectedSamples[0];
      inputVector[1] += selectedSamples[1];
      inputVector[2] += selectedSamples[2];
 
      VxdID thisSensorID = iSD.getSensorID();
      bool thisSide = iSD.isUStrip();
      int thisCellID = iSD.getCellID();
      float thisNoise = noiseCal.getNoise(thisSensorID, thisSide, thisCellID);
      noise += thisNoise * thisNoise;
    }
    noise = sqrt(noise);
    inputVector[0] = inputVector[0] / noise;
    inputVector[1] = inputVector[1] / noise;
    inputVector[2] = inputVector[2] / noise;
  }

  inline void findPossibleCombinations(const Belle2::ClustersOnSensor& aSensor,
                                       std::vector< std::vector<const SVDCluster*> >& foundCombinations,
                                       std::vector< std::pair<int, int> >& foundCombinationIndices, const SVDHitTimeSelection& hitTimeCut,
                                       const bool& useSVDGroupInfo,  const int& numberOfSignalGroups, const bool& formSingleSignalGroup,
                                       const SVDNoiseCalibrations& noiseCal, const DBObjPtr<SVDSpacePointSNRFractionSelector>& svdSpacePointSelectionFunction,
                                       bool useSVDSpacePointSNRFractionSelector)
  {
 
    for (size_t iU = 0; iU < aSensor.clustersU.size(); ++iU) {
      const SVDCluster* uCluster = aSensor.clustersU[iU];
      if (! hitTimeCut.isClusterInTime(uCluster->getSensorID(), 1, uCluster->getClsTime())) {
        B2DEBUG(29, "Cluster rejected due to timing cut. Cluster time: " << uCluster->getClsTime());
        continue;
      }
      for (size_t iV = 0; iV < aSensor.clustersV.size(); ++iV) {
        const SVDCluster* vCluster = aSensor.clustersV[iV];
        if (! hitTimeCut.isClusterInTime(vCluster->getSensorID(), 0, vCluster->getClsTime())) {
          B2DEBUG(29, "Cluster rejected due to timing cut. Cluster time: " << vCluster->getClsTime());
          continue;
        }
 
        if (! hitTimeCut.areClusterTimesCompatible(vCluster->getSensorID(), uCluster->getClsTime(), vCluster->getClsTime())) {
          B2DEBUG(29, "Cluster combination rejected due to timing cut. Cluster time U (" << uCluster->getClsTime() <<
                  ") is incompatible with Cluster time V (" << vCluster->getClsTime() << ")");
          continue;
        }
 
        if (useSVDGroupInfo) {
          const std::vector<int>& uTimeGroupId = uCluster->getTimeGroupId();
          const std::vector<int>& vTimeGroupId = vCluster->getTimeGroupId();
 
          if (int(uTimeGroupId.size()) && int(vTimeGroupId.size())) { // indirect check if the clusterizer module is disabled
            bool isContinue = true;
            for (const auto& uitem : uTimeGroupId) {
              if (uitem < 0 || uitem >= numberOfSignalGroups) continue;
              for (const auto& vitem : vTimeGroupId) {
                if (vitem < 0 || vitem >= numberOfSignalGroups) continue;
                if ((uitem == vitem) || formSingleSignalGroup) { isContinue = false; break; }
              }
              if (!isContinue) break;
            }
 
            if (isContinue) {
              B2DEBUG(29, "Cluster combination rejected due to different time-group Id.");
              continue;
            }
          }
        }
 
        if (useSVDSpacePointSNRFractionSelector) {
          std::vector<float> inputU;
          std::vector<float> inputV;
 
          storeInputVectorFromSingleCluster(uCluster, inputU, noiseCal);
          storeInputVectorFromSingleCluster(vCluster, inputV, noiseCal);
 
          bool pass = svdSpacePointSelectionFunction->passSNRFractionSelection(inputU, inputV);
          if (!pass) {
            B2DEBUG(29, "Cluster combination rejected due to SVDSpacePointSNRFractionSelector");
            continue;
          }
        }
 
        foundCombinations.push_back({uCluster, vCluster});
        foundCombinationIndices.emplace_back(aSensor.indicesU[iU], aSensor.indicesV[iV]);
 
 
      }
    }
 
 
 
 
  }

 
  inline void spPDFName(const VxdID& sensor, int uSize, int vSize, int maxClusterSize, std::string& PDFName,
                        std::string& errorPDFName, bool useLegacyNaming)
  {
    if (useLegacyNaming == true) {
 
      if (uSize > maxClusterSize) uSize = maxClusterSize;
      if (vSize > maxClusterSize) vSize = maxClusterSize;
 
      std::string sensorName;
 
      if (sensor.getLayerNumber() == 3)  sensorName = "l3";
      if (sensor.getLayerNumber() > 3 && sensor.getSensorNumber() == 1)  sensorName = "trap";
      if (sensor.getLayerNumber() > 3 && sensor.getSensorNumber() > 1)  sensorName = "large";
 
      PDFName =  sensorName +  std::to_string(uSize)  + std::to_string(vSize);
      errorPDFName = "error" + PDFName;
    } else {
 
      if (uSize > maxClusterSize) uSize = maxClusterSize;
      if (vSize > maxClusterSize) vSize = maxClusterSize;
 
      int layer = sensor.getLayerNumber();
      int ladder = sensor.getLadderNumber();
      int sens = sensor.getSensorNumber();
 
      PDFName =  std::to_string(layer) + "." + std::to_string(ladder) + "." + std::to_string(sens) + "."  + std::to_string(
                   uSize) + "."  + std::to_string(vSize);
      errorPDFName = PDFName + "_Error";
    }
 
 
 
  }
 

 
 
  inline void calculatePairingProb(TFile* pdfFile, const std::vector<const SVDCluster*>& clusters, double& prob, double& error,
                                   bool useLegacyNaming)
  {
 
    int maxSize;
    int pdfEntries = pdfFile->GetListOfKeys()->GetSize();
    if (useLegacyNaming == true) {
      maxSize = floor(sqrt((pdfEntries - 4) / 6)); //4(time+size)+3(sensors)*2(prob/error)*size^2(u/v combo.)
    } else {
      maxSize = floor(sqrt((pdfEntries - 4) / 344)); //4(time+size)+172(sensorType)*2(prob/error)*size^2(u/v combo.)
    }
    std::string chargeProbInput;
    std::string chargeErrorInput;
 
    spPDFName(clusters[0]->getSensorID(), clusters[0]->getSize(), clusters[1]->getSize(), maxSize,
              chargeProbInput, chargeErrorInput, useLegacyNaming);
    std::string timeProbInput = "timeProb";
    std::string timeErrorInput = "timeError";
    std::string sizeProbInput = "sizeProb";
    std::string sizeErrorInput = "sizeError";
 
 
    TH2F* chargePDF = nullptr;
    TH2F* chargeError = nullptr;
    TH2F* timePDF = nullptr;
    TH2F* timeError = nullptr;
    TH2F* sizePDF = nullptr;
    TH2F* sizeError = nullptr;
 
    pdfFile->GetObject(chargeProbInput.c_str(), chargePDF);
    pdfFile->GetObject(chargeErrorInput.c_str(), chargeError);
    pdfFile->GetObject(timeProbInput.c_str(), timePDF);
    pdfFile->GetObject(timeErrorInput.c_str(), timeError);
    pdfFile->GetObject(sizeProbInput.c_str(), sizePDF);
    pdfFile->GetObject(sizeErrorInput.c_str(), sizeError);
 
    int xChargeBin = chargePDF->GetXaxis()->FindFixBin(clusters[0]->getCharge());
    int yChargeBin = chargePDF->GetYaxis()->FindFixBin(clusters[1]->getCharge());
 
    int xTimeBin = timePDF->GetXaxis()->FindFixBin(clusters[0]->getClsTime());
    int yTimeBin = timePDF->GetYaxis()->FindFixBin(clusters[1]->getClsTime());
 
 
    int xSizeBin = sizePDF->GetXaxis()->FindFixBin(clusters[0]->getSize());
    int ySizeBin = sizePDF->GetYaxis()->FindFixBin(clusters[1]->getSize());
 
    double chargeProb = chargePDF->GetBinContent(xChargeBin, yChargeBin);
    double timeProb = timePDF->GetBinContent(xTimeBin, yTimeBin);
    double sizeProb = sizePDF->GetBinContent(xSizeBin, ySizeBin);
    double chargeProbError = chargePDF->GetBinContent(xChargeBin, yChargeBin);
    double timeProbError = timePDF->GetBinContent(xTimeBin, yTimeBin);
    double sizeProbError = sizePDF->GetBinContent(xSizeBin, ySizeBin);
 
 
    if (chargeProbError == 0) {
      B2DEBUG(21, "svdClusterProbabilityEstimator has not been run, spacePoint QI will return zero!");
    }
 
    prob = chargeProb * timeProb * sizeProb * clusters[0]->getQuality() * clusters[1]->getQuality();
    error = prob * sqrt(square(timeProb * sizeProb * clusters[0]->getQuality() * clusters[1]->getQuality() * chargeProbError) +
                        square(chargeProb * sizeProb * clusters[0]->getQuality() * clusters[1]->getQuality() * timeProbError) +
                        square(chargeProb * timeProb * clusters[0]->getQuality() * clusters[1]->getQuality() * sizeProbError) +
                        square(chargeProb * timeProb * sizeProb * clusters[1]->getQuality() * clusters[0]->getQualityError()) +
                        square(chargeProb * timeProb * sizeProb * clusters[0]->getQuality() * clusters[1]->getQualityError()));
  }

  template <class SpacePointType> void provideSVDClusterCombinations(const StoreArray<SVDCluster>& svdClusters,
      StoreArray<SpacePointType>& spacePoints, SVDHitTimeSelection& hitTimeCut, bool useQualityEstimator, TFile* pdfFile,
      bool useLegacyNaming, unsigned int numMaxSpacePoints, std::string m_eventLevelTrackingInfoName, const bool& useSVDGroupInfo,
      const int& numberOfSignalGroups, const bool& formSingleSignalGroup,
      const SVDNoiseCalibrations& noiseCal, const DBObjPtr<SVDSpacePointSNRFractionSelector>& svdSpacePointSelectionFunction,
      bool useSVDSpacePointSNRFractionSelector)
  {
    std::unordered_map<VxdID::baseType, ClustersOnSensor>
    activatedSensors; // collects one entry per sensor, each entry will contain all Clusters on it TODO: better to use a sorted vector/list?
    std::vector<std::vector<const SVDCluster*> >
    foundCombinations; // collects all combinations of Clusters which were possible (condition: 1u+1v-Cluster on the same sensor)
    std::vector<std::pair<int, int> >
    foundCombinationIndices; // StoreArray indices of the (u, v) clusters of each entry of foundCombinations
 
    // sort Clusters by sensor. After the loop, each entry of activatedSensors contains all U and V-type clusters on that sensor
    for (unsigned int i = 0; i < uint(svdClusters.getEntries()); ++i) {
      SVDCluster* currentCluster = svdClusters[i];
 
      activatedSensors[currentCluster->getSensorID().getID()].addCluster(currentCluster, i);
    }
 
 
    for (const auto& aSensor : activatedSensors)
      findPossibleCombinations(aSensor.second, foundCombinations, foundCombinationIndices, hitTimeCut, useSVDGroupInfo,
                               numberOfSignalGroups, formSingleSignalGroup, noiseCal, svdSpacePointSelectionFunction,
                               useSVDSpacePointSNRFractionSelector);
 
    // Do not make space-points if their number would be too large to be considered by tracking
    if (foundCombinations.size() > numMaxSpacePoints) {
      StoreObjPtr<EventLevelTrackingInfo> m_eventLevelTrackingInfo(m_eventLevelTrackingInfoName);
      if (m_eventLevelTrackingInfo.isValid()) {
        m_eventLevelTrackingInfo->setSVDSpacePointCreatorAbortionFlag();
      }
      return;
    }
 
    // RelationArray is much cheaper than addRelationTo
    // The relation weight codes the type of the cluster: +1 for u and -1 for v.
    RelationArray spacePointsToClusters(spacePoints, svdClusters);
 
    for (size_t iCombi = 0; iCombi < foundCombinations.size(); ++iCombi) {
      auto& clusterCombi = foundCombinations[iCombi];
      const int spacePointIndex = spacePoints.getEntries();
      SpacePointType* newSP = spacePoints.appendNew(clusterCombi);
      if (useQualityEstimator == true) {
        double probability;
        double error;
        calculatePairingProb(pdfFile, clusterCombi, probability, error, useLegacyNaming);
        newSP->setQualityEstimation(probability);
        newSP->setQualityEstimationError(error);
      }
      // the first cluster of the combination is always the u one, the second one the v one
      spacePointsToClusters.add(spacePointIndex, foundCombinationIndices[iCombi].first, 1.);
      spacePointsToClusters.add(spacePointIndex, foundCombinationIndices[iCombi].second, -1.);
    }
  }
 

} //Belle2 namespace