TrackContainmentAlg.cxx

Go to the documentation of this file.

#include "TrackContainmentAlg.hh"

#include "fhiclcpp/ParameterSet.h"
#include "larcorealg/Geometry/GeometryCore.h"

#include <iostream>

#include "TTree.h"

trk::TrackContainmentAlg::TrackContainmentAlg() {}

void trk::TrackContainmentAlg::SetupOutputTree(TTree* tfs_tree_trk)
{
  fTrackTree = tfs_tree_trk;
  fTrackTree->SetObject(fTrackTree->GetName(), "Track Tree");
  fTrackTree->Branch("run", &fRun);
  fTrackTree->Branch("event", &fEvent);
  fTrackTree->Branch("trk", &fTrackTreeObj, fTrackTreeObj.Leaflist().c_str());
  fTrackTree->Branch("trk_col", &fCollection);
  fTrackTree->Branch("trk_id", &fTrkID);
  fTrackTree->Branch("trk_mindist", &fDistance);
  fTrackTree->Branch("trk_containment", &fContainment);
}

void trk::TrackContainmentAlg::Configure(fhicl::ParameterSet const& p)
{
  fZBuffer = p.get<double>("ZBuffer");
  fYBuffer = p.get<double>("YBuffer");
  fXBuffer = p.get<double>("XBuffer");
  fIsolation = p.get<double>("Isolation");

  fDebug = p.get<bool>("Debug", false);
  fMakeCosmicTags = p.get<bool>("MakeCosmicTags", true);
  fFillOutputTree = p.get<bool>("FillOutputTree", true);
}

bool trk::TrackContainmentAlg::IsContained(recob::Track const& track, geo::GeometryCore const& geo)
{
  if (track.Vertex().Z() < (0 + fZBuffer) || track.Vertex().Z() > (geo.DetLength() - fZBuffer))
    return false;
  if (track.End().Z() < (0 + fZBuffer) || track.End().Z() > (geo.DetLength() - fZBuffer))
    return false;
  if (track.Vertex().Y() < (-1 * geo.DetHalfHeight() + fYBuffer) ||
      track.Vertex().Y() > (geo.DetHalfHeight() - fYBuffer))
    return false;
  if (track.End().Y() < (-1 * geo.DetHalfHeight() + fYBuffer) ||
      track.End().Y() > (geo.DetHalfHeight() - fYBuffer))
    return false;
  if (track.Vertex().X() < (0 + fXBuffer) ||
      track.Vertex().X() > (2 * geo.DetHalfWidth() - fXBuffer))
    return false;
  if (track.End().X() < (0 + fXBuffer) || track.End().X() > (2 * geo.DetHalfWidth() - fXBuffer))
    return false;

  return true;
}

anab::CosmicTagID_t trk::TrackContainmentAlg::GetCosmicTagID(recob::Track const& track,
                                                             geo::GeometryCore const& geo)
{

  auto id = anab::CosmicTagID_t::kNotTagged;

  if (track.Vertex().Z() < (0 + fZBuffer) || track.Vertex().Z() > (geo.DetLength() - fZBuffer))
    id = anab::CosmicTagID_t::kGeometry_Z;
  else if (track.Vertex().Y() < (-1 * geo.DetHalfHeight() + fYBuffer) ||
           track.Vertex().Y() > (geo.DetHalfHeight() - fYBuffer))
    id = anab::CosmicTagID_t::kGeometry_Y;
  else if ((track.Vertex().X() > 0 && track.Vertex().X() < (0 + fXBuffer)) ||
           (track.Vertex().X() < 2 * geo.DetHalfWidth() &&
            track.Vertex().X() > (2 * geo.DetHalfWidth() - fXBuffer)))
    id = anab::CosmicTagID_t::kGeometry_X;

  if (track.End().Z() < (0 + fZBuffer) || track.End().Z() > (geo.DetLength() - fZBuffer)) {
    if (id == anab::CosmicTagID_t::kNotTagged)
      id = anab::CosmicTagID_t::kGeometry_Z;
    else if (id == anab::CosmicTagID_t::kGeometry_Z)
      id = anab::CosmicTagID_t::kGeometry_ZZ;
    else if (id == anab::CosmicTagID_t::kGeometry_Y)
      id = anab::CosmicTagID_t::kGeometry_YZ;
    else if (id == anab::CosmicTagID_t::kGeometry_X)
      id = anab::CosmicTagID_t::kGeometry_XZ;
  }
  else if (track.End().Y() < (-1 * geo.DetHalfHeight() + fYBuffer) ||
           track.End().Y() > (geo.DetHalfHeight() - fYBuffer)) {
    if (id == anab::CosmicTagID_t::kNotTagged)
      id = anab::CosmicTagID_t::kGeometry_Y;
    else if (id == anab::CosmicTagID_t::kGeometry_Z)
      id = anab::CosmicTagID_t::kGeometry_YZ;
    else if (id == anab::CosmicTagID_t::kGeometry_Y)
      id = anab::CosmicTagID_t::kGeometry_YY;
    else if (id == anab::CosmicTagID_t::kGeometry_X)
      id = anab::CosmicTagID_t::kGeometry_XY;
  }
  else if ((track.End().X() > 0 && track.End().X() < (0 + fXBuffer)) ||
           (track.End().X() < 2 * geo.DetHalfWidth() &&
            track.End().X() > (2 * geo.DetHalfWidth() - fXBuffer))) {
    if (id == anab::CosmicTagID_t::kNotTagged)
      id = anab::CosmicTagID_t::kGeometry_X;
    else if (id == anab::CosmicTagID_t::kGeometry_Z)
      id = anab::CosmicTagID_t::kGeometry_XZ;
    else if (id == anab::CosmicTagID_t::kGeometry_Y)
      id = anab::CosmicTagID_t::kGeometry_XY;
    else if (id == anab::CosmicTagID_t::kGeometry_X)
      id = anab::CosmicTagID_t::kGeometry_XX;
  }

  if (track.Vertex().X() < 0 || track.Vertex().X() > 2 * geo.DetHalfWidth())
    id = anab::CosmicTagID_t::kOutsideDrift_Partial;
  if (track.End().X() < 0 || track.End().X() > 2 * geo.DetHalfWidth()) {
    if (id == anab::CosmicTagID_t::kOutsideDrift_Partial)
      id = anab::CosmicTagID_t::kOutsideDrift_Complete;
    else
      id = anab::CosmicTagID_t::kOutsideDrift_Partial;
  }

  return id;
}

double trk::TrackContainmentAlg::MinDistanceStartPt(recob::Track const& t_probe,
                                                    recob::Track const& t_ref)
{
  double min_distance = 9e12;
  double tmp;
  for (size_t i_p = 0; i_p < t_ref.NumberTrajectoryPoints(); ++i_p) {
    tmp = (t_probe.Vertex().X() - t_ref.LocationAtPoint(i_p).X()) *
            (t_probe.Vertex().X() - t_ref.LocationAtPoint(i_p).X()) +
          (t_probe.Vertex().Y() - t_ref.LocationAtPoint(i_p).Y()) *
            (t_probe.Vertex().Y() - t_ref.LocationAtPoint(i_p).Y()) +
          (t_probe.Vertex().Z() - t_ref.LocationAtPoint(i_p).Z()) *
            (t_probe.Vertex().Z() - t_ref.LocationAtPoint(i_p).Z());
    //std::cout << "\t\t\ttmp=" << tmp << std::endl;
    if (tmp < min_distance) min_distance = tmp;
  }
  return std::sqrt(min_distance);
}

double trk::TrackContainmentAlg::MinDistanceEndPt(recob::Track const& t_probe,
                                                  recob::Track const& t_ref)
{
  double min_distance = 9e12;
  double tmp;
  for (size_t i_p = 0; i_p < t_ref.NumberTrajectoryPoints(); ++i_p) {
    tmp = (t_probe.End().X() - t_ref.LocationAtPoint(i_p).X()) *
            (t_probe.End().X() - t_ref.LocationAtPoint(i_p).X()) +
          (t_probe.End().Y() - t_ref.LocationAtPoint(i_p).Y()) *
            (t_probe.End().Y() - t_ref.LocationAtPoint(i_p).Y()) +
          (t_probe.End().Z() - t_ref.LocationAtPoint(i_p).Z()) *
            (t_probe.End().Z() - t_ref.LocationAtPoint(i_p).Z());
    if (tmp < min_distance) min_distance = tmp;
  }
  return std::sqrt(min_distance);
}

void trk::TrackContainmentAlg::SetRunEvent(unsigned int const& run, unsigned int const& event)
{
  fRun = run;
  fEvent = event;
}

void trk::TrackContainmentAlg::ProcessTracks(
  std::vector<std::vector<recob::Track>> const& tracksVec,
  geo::GeometryCore const& geo)
{

  if (fDebug) {
    std::cout << "Geometry:" << std::endl;
    std::cout << "\t" << geo.DetHalfWidth() << " " << geo.DetHalfHeight() << " " << geo.DetLength()
              << std::endl;
    std::cout << "\t z:(" << fZBuffer << "," << geo.DetLength() - fZBuffer << ")"
              << "\t y:(" << -1. * geo.DetHalfHeight() + fYBuffer << ","
              << geo.DetHalfHeight() - fYBuffer << ")"
              << "\t x:(" << 0 + fXBuffer << "," << 2 * geo.DetHalfWidth() - fXBuffer << ")"
              << std::endl;
  }

  int containment_level = 0;
  bool track_linked = false;

  fTrackContainmentLevel.clear();
  fTrackContainmentLevel.resize(tracksVec.size());
  fMinDistances.clear();
  fMinDistances.resize(tracksVec.size());

  fTrackContainmentIndices.clear();
  fTrackContainmentIndices.push_back(std::vector<std::pair<int, int>>());

  fCosmicTags.clear();
  fCosmicTags.resize(tracksVec.size());

  //first, loop through tracks and see what's not contained

  for (size_t i_tc = 0; i_tc < tracksVec.size(); ++i_tc) {
    fTrackContainmentLevel[i_tc].resize(tracksVec[i_tc].size(), -1);
    fMinDistances[i_tc].resize(tracksVec[i_tc].size(), 9e12);
    fCosmicTags[i_tc].resize(tracksVec[i_tc].size(), anab::CosmicTag(-1));
    for (size_t i_t = 0; i_t < tracksVec[i_tc].size(); ++i_t) {

      if (!IsContained(tracksVec[i_tc][i_t], geo)) {
        if (!track_linked) track_linked = true;
        fTrackContainmentLevel[i_tc][i_t] = 0;
        fTrackContainmentIndices.back().emplace_back(i_tc, i_t);
        if (fDebug) {
          std::cout << "\tTrack (" << i_tc << "," << i_t << ")"
                    << " " << containment_level << std::endl;
        }

      } //end if contained
    }   //end loop over tracks

  } //end loop over track collections

  //now, while we are still linking tracks, loop over all tracks and note anything
  //close to an uncontained (or linked) track
  while (track_linked) {

    track_linked = false;
    ++containment_level;
    fTrackContainmentIndices.push_back(std::vector<std::pair<int, int>>());

    for (size_t i_tc = 0; i_tc < tracksVec.size(); ++i_tc) {
      for (size_t i_t = 0; i_t < tracksVec[i_tc].size(); ++i_t) {
        if (fTrackContainmentLevel[i_tc][i_t] >= 0)
          continue;
        else {
          for (auto const& i_tr : fTrackContainmentIndices[containment_level - 1]) {

            /*
              if(fDebug){
                std::cout << "\t\t" << MinDistanceStartPt(tracksVec[i_tc][i_t],tracksVec[i_tr.first][i_tr.second]) << std::endl;
                std::cout << "\t\t" << MinDistanceEndPt(tracksVec[i_tc][i_t],tracksVec[i_tr.first][i_tr.second]) << std::endl;
              }
              */

            if (MinDistanceStartPt(tracksVec[i_tc][i_t], tracksVec[i_tr.first][i_tr.second]) <
                fMinDistances[i_tc][i_t])
              fMinDistances[i_tc][i_t] =
                MinDistanceStartPt(tracksVec[i_tc][i_t], tracksVec[i_tr.first][i_tr.second]);
            if (MinDistanceEndPt(tracksVec[i_tc][i_t], tracksVec[i_tr.first][i_tr.second]) <
                fMinDistances[i_tc][i_t])
              fMinDistances[i_tc][i_t] =
                MinDistanceEndPt(tracksVec[i_tc][i_t], tracksVec[i_tr.first][i_tr.second]);

            if (MinDistanceStartPt(tracksVec[i_tc][i_t], tracksVec[i_tr.first][i_tr.second]) <
                  fIsolation ||
                MinDistanceEndPt(tracksVec[i_tc][i_t], tracksVec[i_tr.first][i_tr.second]) <
                  fIsolation) {
              if (!track_linked) track_linked = true;
              fTrackContainmentLevel[i_tc][i_t] = containment_level;
              fTrackContainmentIndices.back().emplace_back(i_tc, i_t);

              if (fDebug) {
                std::cout << "\tTrackPair (" << i_tc << "," << i_t << ") and (" << i_tr.first << ","
                          << i_tr.second << ")"
                          << " " << containment_level << std::endl;
              }

            } //end if track not isolated

          } //end loop over existing uncontained/linked tracks

        } //end if track not already linked

      } //end loops over tracks
    }   //end loop over track collections
  }     //end while linking tracks

  if (fDebug) std::cout << "All done! Now let's make the tree and tags!" << std::endl;

  //now we're going to will the tree and create tags if requested
  for (size_t i_tc = 0; i_tc < tracksVec.size(); ++i_tc) {
    for (size_t i_t = 0; i_t < tracksVec[i_tc].size(); ++i_t) {

      //fill ROOT Tree
      if (fFillOutputTree) {
        fTrackTreeObj = TrackTree_t(tracksVec[i_tc][i_t]);
        fDistance = fMinDistances[i_tc][i_t];
        fCollection = i_tc;
        fTrkID = i_t;
        fContainment = fTrackContainmentLevel[i_tc][i_t];
        fTrackTree->Fill();
      }

      if (fMakeCosmicTags) {

        //default (if track looks contained and isolated)
        float score = 0;
        auto id = anab::CosmicTagID_t::kNotTagged;

        //overwrite if track is not contained or not isolated
        if (fTrackContainmentLevel[i_tc][i_t] >= 0) {
          score = 1. / (1. + (float)fTrackContainmentLevel[i_tc][i_t]);
          if (fTrackContainmentLevel[i_tc][i_t] == 0)
            id = GetCosmicTagID(tracksVec[i_tc][i_t], geo);
          else
            id = anab::CosmicTagID_t::kNotIsolated;
        }

        fCosmicTags[i_tc][i_t] =
          anab::CosmicTag(std::vector<float>{(float)tracksVec[i_tc][i_t].Vertex().X(),
                                             (float)tracksVec[i_tc][i_t].Vertex().Y(),
                                             (float)tracksVec[i_tc][i_t].Vertex().Z()},
                          std::vector<float>{(float)tracksVec[i_tc][i_t].End().X(),
                                             (float)tracksVec[i_tc][i_t].End().Y(),
                                             (float)tracksVec[i_tc][i_t].End().Z()},
                          score,
                          id);
      } //end cosmic tag making

      //some debug work
      if (fTrackContainmentLevel[i_tc][i_t] < 0 && fDebug) {
        std::cout << "Track (" << i_tc << "," << i_t << ")"
                  << " " << fTrackContainmentLevel[i_tc][i_t] << " " << fMinDistances[i_tc][i_t]
                  << std::endl;
        auto const& vertex = tracksVec[i_tc][i_t].Vertex();
        std::cout << "\tS_(X,Y,Z) = (" << vertex.X() << "," << vertex.Y() << "," << vertex.Z()
                  << ")\n";
        std::cout << "\tNearest wire ..." << std::endl;
        for (unsigned int i_p = 0; i_p < geo.Nplanes(); ++i_p)
          std::cout << "\t\tPlane " << i_p << " "
                    << geo.NearestWireID(vertex, geo::PlaneID{0, 0, i_p}).Wire << std::endl;

        auto const& end = tracksVec[i_tc][i_t].End();
        std::cout << "\tE_(X,Y,Z) = (" << end.X() << "," << end.Y() << "," << end.Z() << ")\n";
        std::cout << "\tNearest wire ..." << std::endl;
        for (unsigned int i_p = 0; i_p < geo.Nplanes(); ++i_p)
          std::cout << "\t\tPlane " << i_p << " "
                    << geo.NearestWireID(end, geo::PlaneID{0, 0, i_p}).Wire << std::endl;
        std::cout << "\tLength=" << tracksVec[i_tc][i_t].Length() << std::endl;
        std::cout << "\tSimple_length=" << (end - vertex).R() << std::endl;
      } //end debug statements if track contained

    } //end loops over tracks
  }   //end loop over track collections

} //end ProcessTracks

std::vector<std::vector<anab::CosmicTag>> const& trk::TrackContainmentAlg::GetTrackCosmicTags()
{
  if (fMakeCosmicTags)
    return fCosmicTags;
  else
    throw cet::exception("TrackContainmentAlg::GetTrackCosmicTags")
      << "Cosmic tags not created. Set MakeCosmicTags to true in fcl paramters.";
}