trkf::KalmanFilterAlg Class Reference

#include "KalmanFilterAlg.h"

Public Member Functions
	KalmanFilterAlg (const fhicl::ParameterSet &pset)
	Constructor. More...
	~KalmanFilterAlg ()
	Destructor. More...
void	reconfigure (const fhicl::ParameterSet &pset)
	Reconfigure method. More...
bool	getTrace () const
	Trace config parameters. More...
int	getPlane () const
	Preferred view plane. More...
void	setTrace (bool trace)
	Set trace config parameter. More...
void	setPlane (int plane)
	Set preferred view plane. More...
bool	buildTrack (const KTrack &trk, KGTrack &trg, const Propagator *prop, const Propagator::PropDirection dir, KHitContainer &hits, bool linear) const
	Make a new track. More...
bool	smoothTrack (KGTrack &trg, KGTrack *trg1, const Propagator *prop) const
	Smooth track. More...
bool	extendTrack (KGTrack &trg, const Propagator *prop, KHitContainer &hits) const
	Add hits to existing track. More...
bool	fitMomentumRange (const KGTrack &trg, const Propagator *prop, KETrack &tremom) const
	Estimate track momentum using range. More...
bool	fitMomentumMS (const KGTrack &trg, const Propagator *prop, KETrack &tremom) const
	Estimate track momentum using multiple scattering. More...
bool	fitMomentum (const KGTrack &trg, const Propagator *prop, KETrack &tremom) const
	Estimate track momentum using either range or multiple scattering. More...
bool	updateMomentum (const KETrack &tremom, const Propagator *prop, KGTrack &trg) const
	Set track momentum at each track surface. More...
bool	smoothTrackIter (int niter, KGTrack &trg, const Propagator *prop) const
	Iteratively smooth a track. More...
void	cleanTrack (KGTrack &trg) const
	Clean track by removing noise hits near endpoints. More...

Private Attributes
bool	fTrace
	Trace flag. More...
double	fMaxPErr
	Maximum pointing error for free propagation. More...
double	fGoodPErr
	Pointing error threshold for switching to free propagation. More...
double	fMaxIncChisq
	Maximum incremental chisquare to accept a hit. More...
double	fMaxSeedIncChisq
	Maximum incremental chisquare to accept a hit in seed phase. More...
double	fMaxSmoothIncChisq
	Maximum incremental chisquare to accept a hit in smooth phase. More...
double	fMaxEndChisq
	Maximum incremental chisquare for endpoint hit. More...
int	fMinLHits
	Minimum number of hits to turn off linearized propagation. More...
double	fMaxLDist
	Maximum distance for linearized propagation. More...
double	fMaxPredDist
	Maximum prediciton distance to accept a hit. More...
double	fMaxSeedPredDist
	Maximum prediciton distance to accept a hit in seed phase. More...
double	fMaxPropDist
	Maximum propagation distance to candidate surface. More...
double	fMinSortDist
	Sort low distance threshold. More...
double	fMaxSortDist
	Sort high distance threshold. More...
int	fMaxSamePlane
	Maximum consecutive hits in same plane. More...
double	fGapDist
	Minimum gap distance. More...
int	fMaxNoiseHits
	Maximum number of hits in noise cluster. More...
double	fMinSampleDist
	Minimum sample distance (for momentum measurement). More...
bool	fFitMomRange
	Fit momentum using range. More...
bool	fFitMomMS
	Fit momentum using multiple scattering. More...
bool	fGTrace
	Graphical trace flag. More...
double	fGTraceWW
	Window width. More...
double	fGTraceWH
	Window height. More...
double	fGTraceXMin
	Graphical trace minimum x. More...
double	fGTraceXMax
	Graphical trace maximum x. More...
std::vector< double >	fGTraceZMin
	Graphical trace minimum z for each view. More...
std::vector< double >	fGTraceZMax
	Graphical trace maximum z for each view. More...
int	fPlane
	Preferred view plane. More...
std::vector< std::unique_ptr< TCanvas > >	fCanvases
	Graphical trace canvases. More...
std::vector< TVirtualPad * >	fPads
	View pads in current canvas. More...
TVirtualPad *	fInfoPad
	Information pad. More...
TPaveText *	fMessages
	Message box. More...
std::map< int, TMarker * >	fMarkerMap
	Markers in current canvas. More...

Detailed Description

Definition at line 57 of file KalmanFilterAlg.h.

Constructor & Destructor Documentation

trkf::KalmanFilterAlg::KalmanFilterAlg

(

const fhicl::ParameterSet &

pset

)

Constructor.

Definition at line 229 of file KalmanFilterAlg.cxx.

References reconfigure().

                                                                  :
  fTrace(false),
  fMaxPErr(0.),
  fGoodPErr(0.),
  fMaxIncChisq(0.),
  fMaxSeedIncChisq(0.),
  fMaxSmoothIncChisq(0.),
  fMaxEndChisq(0.),
  fMinLHits(0),
  fMaxLDist(0.),
  fMaxPredDist(0.),
  fMaxSeedPredDist(0.),
  fMaxPropDist(0.),
  fMinSortDist(0.),
  fMaxSortDist(0.),
  fMaxSamePlane(0),
  fGapDist(0.),
  fMaxNoiseHits(0),
  fMinSampleDist(0.),
  fFitMomRange(false),
  fFitMomMS(false),
  fGTrace(false),
  fGTraceWW(0),
  fGTraceWH(0),
  fPlane(-1),
  fInfoPad(0),
  fMessages(0)
{
  mf::LogInfo("KalmanFilterAlg") << "KalmanFilterAlg instantiated.";

  // Load fcl parameters.

  reconfigure(pset);
}

trkf::KalmanFilterAlg::~KalmanFilterAlg

(

)

Destructor.

Definition at line 265 of file KalmanFilterAlg.cxx.

{}

Member Function Documentation

bool trkf::KalmanFilterAlg::buildTrack	(	const KTrack &	trk,
		KGTrack &	trg,
		const Propagator *	prop,
		const Propagator::PropDirection	dir,
		KHitContainer &	hits,
		bool	linear
	)		const

Make a new track.

Add hits to track.

Arguments:

trk - Starting track. trg - Result global track. prop - Propagator. dir - Direction. hits - Candidate hits.

Returns: True if success.

This method makes a unidirectional Kalman fit in the specified direction, visiting each surface of the passed KHitContainer and updating the track. In case of multiple measurements on the same surface, keep (at most) the one with the smallest incremental chisquare. Any measurements that fail the incremental chisquare cut are rejected. Resolved hits (accepted or rejected) are moved to the unused list in KHitContainer. The container is sorted at the start of the method, and may be resorted during the progress of the fit.

Definition at line 324 of file KalmanFilterAlg.cxx.

References trkf::KGTrack::addTrack(), trkf::KFitTrack::BACKWARD, trkf::Propagator::BACKWARD, trkf::KFitTrack::BACKWARD_PREDICTED, cleanTrack(), trkf::KGTrack::endTrack(), fCanvases, fGoodPErr, fGTrace, fGTraceWH, fGTraceWW, fGTraceXMax, fGTraceXMin, fGTraceZMax, fGTraceZMin, fInfoPad, fMarkerMap, fMaxLDist, fMaxPErr, fMaxPropDist, fMaxSamePlane, fMaxSeedIncChisq, fMaxSeedPredDist, fMaxSortDist, fMessages, fMinLHits, trkf::KFitTrack::FORWARD, trkf::Propagator::FORWARD, trkf::KFitTrack::FORWARD_PREDICTED, fPads, fPlane, fTrace, trkf::KFitTrack::getChisq(), trkf::KHitBase::getChisq(), trkf::KHitGroup::getHits(), trkf::KHitBase::getID(), trkf::KHitBase::getMeasPlane(), trkf::KHitGroup::getPath(), trkf::KFitTrack::getPath(), trkf::KHitGroup::getPlane(), trkf::KHitBase::getPredDistance(), trkf::KHitContainer::getSorted(), trkf::KHitGroup::getSurface(), trkf::KTrack::getSurface(), trkf::KHitContainer::getUnsorted(), trkf::KHitContainer::getUnused(), trkf::KGTrack::isValid(), trkf::KTrack::isValid(), leg, trkf::Propagator::noise_prop(), trkf::KGTrack::numHits(), trkf::KFitTrack::OPTIMAL, trkf::KETrack::PointingError(), trkf::KHitBase::predict(), trkf::KFitTrack::setChisq(), trkf::KFitTrack::setPath(), trkf::KFitTrack::setStat(), trkf::KHitContainer::sort(), trkf::KGTrack::startTrack(), trkf::Propagator::UNKNOWN, and lar::dump::vector().

Referenced by trkf::Track3DKalmanHitAlg::makeKalmanTracks(), trkf::TrackKalmanCheater::produce(), and setPlane().

{
  if (!prop)
    throw cet::exception("KalmanFilterAlg") << "trkf::KalmanFilterAlg::buildTrack(): no propagator\n";

  // Direction must be forward or backward (unknown is not allowed).

  if(dir != Propagator::FORWARD && dir != Propagator::BACKWARD)
    throw cet::exception("KalmanFilterAlg") 
        << "No direction for Kalman fit.\n";

  // Set up canvas for graphical trace.

  if(fGTrace) {

    // Make a new canvas with a unique name.

    static int cnum=0;
    ++cnum;
    std::ostringstream ostr;
    ostr << "khit" << cnum;
    fCanvases.emplace_back(new TCanvas(ostr.str().c_str(), ostr.str().c_str(),
                                       fGTraceWW, fGTraceWH));
    fPads.clear();
    fMarkerMap.clear();
    int nview = 3;
    fCanvases.back()->Divide(2, nview/2 + 1);

    // Make subpad for each view.

    for(int iview=0; iview < nview; ++iview) {

      std::ostringstream ostr;
      ostr << "Plane " << iview;

      fCanvases.back()->cd(iview+1);
      double zmin = 0.06;
      double zmax = 0.94;
      double xmin = 0.04;
      double xmax = 0.95;
      TPad* p = new TPad(ostr.str().c_str(), ostr.str().c_str(), zmin, xmin, zmax, xmax);
      p->SetBit(kCanDelete);   // Give away ownership.
      p->Range(fGTraceZMin[iview], fGTraceXMin, fGTraceZMax[iview], fGTraceXMax);
      p->SetFillStyle(4000);   // Transparent.
      p->Draw();
      fPads.push_back(p);

      // Draw label.

      TText* t = new TText(zmax-0.02, xmax-0.03, ostr.str().c_str());
      t->SetBit(kCanDelete);   // Give away ownership.
      t->SetTextAlign(33);
      t->SetTextFont(42);
      t->SetTextSize(0.04);
      t->Draw();

      // Draw axes.

      TGaxis* pz1 = new TGaxis(zmin, xmin, zmax, xmin,
                               fGTraceZMin[iview], fGTraceZMax[iview], 510, "");
      pz1->SetBit(kCanDelete);   // Give away ownership.
      pz1->Draw();

      TGaxis* px1 = new TGaxis(zmin, xmin, zmin, xmax,
                               fGTraceXMin, fGTraceXMax, 510, "");
      px1->SetBit(kCanDelete);   // Give away ownership.
      px1->Draw();
      
      TGaxis* pz2 = new TGaxis(zmin, xmax, zmax, xmax,
                               fGTraceZMin[iview], fGTraceZMax[iview], 510, "-");
      pz2->SetBit(kCanDelete);   // Give away ownership.
      pz2->Draw();

      TGaxis* px2 = new TGaxis(zmax, xmin, zmax, xmax,
                               fGTraceXMin, fGTraceXMax, 510, "L+");
      px2->SetBit(kCanDelete);   // Give away ownership.
      px2->Draw();
      
    }

    // Draw legend.

    fCanvases.back()->cd(nview+1);
    fInfoPad = gPad;
    TLegend* leg = new TLegend(0.6, 0.5, 0.99, 0.99);
    leg->SetBit(kCanDelete);   // Give away ownership.

    TLegendEntry* entry = 0;
    TMarker* m = 0;

    m = new TMarker(0., 0., 20);
    m->SetBit(kCanDelete);
    m->SetMarkerSize(1.2);
    m->SetMarkerColor(kRed);
    entry = leg->AddEntry(m, "Hits on Track", "P");
    entry->SetBit(kCanDelete);

    m = new TMarker(0., 0., 20);
    m->SetBit(kCanDelete);
    m->SetMarkerSize(1.2);
    m->SetMarkerColor(kOrange);
    entry = leg->AddEntry(m, "Smoothed Hits on Track", "P");
    entry->SetBit(kCanDelete);

    m = new TMarker(0., 0., 20);
    m->SetBit(kCanDelete);
    m->SetMarkerSize(1.2);
    m->SetMarkerColor(kBlack);
    entry = leg->AddEntry(m, "Available Hits", "P");
    entry->SetBit(kCanDelete);

    m = new TMarker(0., 0., 20);
    m->SetBit(kCanDelete);
    m->SetMarkerSize(1.2);
    m->SetMarkerColor(kBlue);
    entry = leg->AddEntry(m, "Rejected Hits", "P");
    entry->SetBit(kCanDelete);

    m = new TMarker(0., 0., 20);
    m->SetBit(kCanDelete);
    m->SetMarkerSize(1.2);
    m->SetMarkerColor(kGreen);
    entry = leg->AddEntry(m, "Removed Hits", "P");
    entry->SetBit(kCanDelete);

    m = new TMarker(0., 0., 20);
    m->SetBit(kCanDelete);
    m->SetMarkerSize(1.2);
    m->SetMarkerColor(kMagenta);
    entry = leg->AddEntry(m, "Seed Hits", "P");
    entry->SetBit(kCanDelete);

    m = new TMarker(0., 0., 20);
    m->SetBit(kCanDelete);
    m->SetMarkerSize(1.2);
    m->SetMarkerColor(kCyan);
    entry = leg->AddEntry(m, "Unreachable Seed Hits", "P");
    entry->SetBit(kCanDelete);

    leg->Draw();

    // Draw message box.
    
    fMessages = new TPaveText(0.01, 0.01, 0.55, 0.99, "");
    fMessages->SetBit(kCanDelete);
    fMessages->SetTextFont(42);
    fMessages->SetTextSize(0.04);
    fMessages->SetTextAlign(12);
    fMessages->Draw();
    TText* t = fMessages->AddText("Enter buildTrack");
    t->SetBit(kCanDelete);

    fCanvases.back()->Update();
  }

  // Sort container using this seed track.

  hits.sort(trk, true, prop, Propagator::UNKNOWN);

  // Draw hits and populate hit->marker map.

  if(fGTrace && fCanvases.size() > 0) {

    // Loop over sorted KHitGroups.
    // Paint sorted seed hits magenta.

    const std::list<KHitGroup>& groups = hits.getSorted();
    for(auto const& gr : groups) {

      // Loop over hits in this group.

      const std::vector<std::shared_ptr<const KHitBase> >& phits = gr.getHits();
      for(auto const& phit : phits) {
        const KHitBase& hit = *phit;
        int pl = hit.getMeasPlane();
        if(pl >= 0 && pl < int(fPads.size())) {
          double z = 0.;
          double x = 0.;
          hit_position(hit, z, x);
          TMarker* marker = new TMarker(z, x, 20);
          fMarkerMap[hit.getID()] = marker;
          fPads[pl]->cd();
          marker->SetBit(kCanDelete);   // Give away ownership.
          marker->SetMarkerSize(0.5);
          marker->SetMarkerColor(kMagenta);
          marker->Draw();
        }
      }
    }

    // Loop over unsorted KHitGroups.
    // Paint unsorted seed hits cyan.
    // There should be few, if any, unsorted seed hits.

    const std::list<KHitGroup>& ugroups = hits.getUnsorted();
    for(auto const& gr : ugroups) {

      // Loop over hits in this group.

      const std::vector<std::shared_ptr<const KHitBase> >& phits = gr.getHits();
      for(auto const& phit : phits) {
        const KHitBase& hit = *phit;
        int pl = hit.getMeasPlane();
        if(pl >= 0 && pl < int(fPads.size())) {
          double z = 0.;
          double x = 0.;
          hit_position(hit, z, x);
          TMarker* marker = new TMarker(z, x, 20);
          fMarkerMap[hit.getID()] = marker;
          fPads[pl]->cd();
          marker->SetBit(kCanDelete);   // Give away ownership.
          marker->SetMarkerSize(0.5);
          marker->SetMarkerColor(kCyan);
          marker->Draw();
        }
      }
    }
    fCanvases.back()->Update();
  }

  // Loop over measurements (KHitGroup) from sorted list.

  double tchisq = 0.;        // Cumulative chisquare.
  double path = 0.;          // Cumulative path distance.
  int step = 0;              // Step count.
  int nsame = 0;             // Number of consecutive measurements in same plane.
  int last_plane = -1;       // Last plane.
  bool has_pref_plane = false; // Set to true when first preferred plane hit is added to track.

  // Make a copy of the starting track, in the form of a KFitTrack,
  // which we will update as we go.

  TrackError err;
  trk.getSurface()->getStartingError(err);
  KETrack tre(trk, err);
  KFitTrack trf(tre, path, tchisq);

  // Also use the starting track as the reference track for linearized
  // propagation, until the track is established with reasonably small
  // errors.

  KTrack ref(trk);
  KTrack* pref = &ref;

  mf::LogInfo log("KalmanFilterAlg");

  // Loop over measurement groups (KHitGroups).

  while(hits.getSorted().size() > 0) {
    ++step;
    if(fTrace) {
      log << "Build Step " << step << "\n";
      log << "KGTrack has " << trg.numHits() << " hits.\n";
      log << trf;
    }

    // Get an iterator for the next KHitGroup.

    std::list<KHitGroup>::iterator it;
    if(dir == Propagator::FORWARD)
      it = hits.getSorted().begin();
    else {
      it = hits.getSorted().end();
      --it;
    }
    const KHitGroup& gr = *it;

    if(fTrace) {
      double path_est = gr.getPath();
      log << "Next surface: " << *(gr.getSurface()) << "\n";
      log << "  Estimated path length of hit group = " << path_est << "\n";
    }

    // Get the next prediction surface.  If this KHitGroup is on the
    // preferred plane, use that as the prediction surface.
    // Otherwise, use the current track surface as the prediction
    // surface.

    std::shared_ptr<const Surface> psurf = trf.getSurface();
    if (gr.getPlane() < 0)
      throw cet::exception("KalmanFilterAlg") << "negative plane?\n";
    if(fPlane < 0 || gr.getPlane() < 0 || fPlane == gr.getPlane())
      psurf = gr.getSurface();

    // Propagate track to the prediction surface.

    boost::optional<double> dist = prop->noise_prop(trf, psurf, Propagator::UNKNOWN, true, pref);
    if(!!dist && std::abs(*dist) > fMaxPropDist)
      dist = boost::optional<double>(false, 0.);
    double ds = 0.;

    if(!!dist) {

      // Propagation succeeded.
      // Update cumulative path distance and track status.

      ds = *dist;
      path += ds;
      trf.setPath(path);
      if(dir == Propagator::FORWARD)
        trf.setStat(KFitTrack::FORWARD_PREDICTED);
      else {
        trf.setStat(KFitTrack::BACKWARD_PREDICTED);
      }
      if(fTrace) {
        log << "After propagation\n";
        log << "  Incremental propagation distance = " << ds << "\n";
        log << "  Path length of prediction surface = " << path << "\n";
        log << "KGTrack has " << trg.numHits() << " hits.\n";
        log << trf;
      }

      // Loop over measurements in this group.

      const std::vector<std::shared_ptr<const KHitBase> >& hits = gr.getHits();
      double best_chisq = 0.;
      std::shared_ptr<const KHitBase> best_hit;
      for(std::vector<std::shared_ptr<const KHitBase> >::const_iterator ihit = hits.begin();
          ihit != hits.end(); ++ihit) {
        const KHitBase& hit = **ihit;

        // Turn this hit blue.

        if(fGTrace && fCanvases.size() > 0) {
          auto marker_it = fMarkerMap.find(hit.getID());
          if(marker_it != fMarkerMap.end()) {
            TMarker* marker = marker_it->second;
            marker->SetMarkerColor(kBlue);
          }
          //fCanvases.back()->Update();
        }

        // Update predction using current track hypothesis and get
        // incremental chisquare.

        bool ok = hit.predict(trf, prop);
        if(ok) {
          double chisq = hit.getChisq();
          double preddist = hit.getPredDistance();
          if(fTrace) {
            log << "Trying Hit.\n"
                << hit
                << "\nchisq = " << chisq << "\n"
                << "prediction distance = " << preddist << "\n";
          }
          if((!has_pref_plane || abs(preddist) < fMaxSeedPredDist) &&
             (best_hit.get() == 0 || chisq < best_chisq) ) {
            best_chisq = chisq;
            if(chisq < fMaxSeedIncChisq)
              best_hit = *ihit;
          }
        }
      }
      if(fTrace) {
        log << "Best hit incremental chisquare = " << best_chisq << "\n";
        if(best_hit.get() != 0) {
          log << "Hit after prediction\n";
          log << *best_hit;
        }
        else
          log << "No hit passed chisquare cut.\n";
      }
      if(fGTrace && fCanvases.size() > 0)
        fCanvases.back()->Update();

      // If we found a best measurement, and if the incremental
      // chisquare passes the cut, add it to the track and update 
      // fit information.

      bool update_ok = false;
      if(best_hit.get() != 0) {
        KFitTrack trf0(trf);
        best_hit->update(trf);
        update_ok = trf.isValid();
        if(!update_ok)
          trf = trf0;
      }
      if(update_ok) {
        ds += best_hit->getPredDistance();
        tchisq += best_chisq;
        trf.setChisq(tchisq);
        if(dir == Propagator::FORWARD)
          trf.setStat(KFitTrack::FORWARD);
        else {
          trf.setStat(KFitTrack::BACKWARD);
        }

        // If the pointing error got too large, and there is no
        // reference track, quit.

        if(pref == 0 && trf.PointingError() > fMaxPErr) {
          if(fTrace)
            log << "Quitting because pointing error got too large.\n";
          break;
        }
          
        // Test number of consecutive measurements in the same plane.

        if(gr.getPlane() >= 0) {
          if(gr.getPlane() == last_plane)
            ++nsame;
          else {
            nsame = 1;
            last_plane = gr.getPlane();
          }
        }
        else {
          nsame = 0;
          last_plane = -1;
        }
        if(nsame <= fMaxSamePlane) {

          // Turn best hit red.

          if(fGTrace && fCanvases.size() > 0) {
            int pl = best_hit->getMeasPlane();
            if(pl >= 0 && pl < int(fPads.size())) {
              auto marker_it = fMarkerMap.find(best_hit->getID());
              if(marker_it != fMarkerMap.end()) {
                TMarker* marker = marker_it->second;
                marker->SetMarkerColor(kRed);

                // Redraw marker so that it will be on top.

                fPads[pl]->cd();
                marker->Draw();
              }
            }
            fCanvases.back()->Update();
          }

          // Make a KHitTrack and add it to the KGTrack.

          KHitTrack trh(trf, best_hit);
          trg.addTrack(trh);
          if(fPlane == gr.getPlane())
            has_pref_plane = true;

          // Decide if we want to kill the reference track.

          if(!linear && pref != 0 && int(trg.numHits()) >= fMinLHits &&
             (trf.PointingError() < fGoodPErr || path > fMaxLDist)) {
            pref = 0;
            if(fTrace)
              log << "Killing reference track.\n";
          }

          if(fTrace) {
            log << "After update\n";
            log << "KGTrack has " << trg.numHits() << " hits.\n";
            log << trf;
          }
        }
      }
    }

    // The current KHitGroup is now resolved.
    // Move it to unused list.

    hits.getUnused().splice(hits.getUnused().end(), hits.getSorted(), it);

    // If the propagation distance was the wrong direction, resort the measurements.

    if(pref == 0 && !!dist && 
       ((dir == Propagator::FORWARD && (ds < fMinSortDist || ds > fMaxSortDist)) ||
        (dir == Propagator::BACKWARD && (-ds < fMinSortDist || -ds > fMaxSortDist)))) {
      if(fTrace)
        log << "Resorting measurements.\n";
      hits.sort(trf, true, prop, dir);
    }
  }

  // Clean track.

  cleanTrack(trg);

  // Set the fit status of the last added KHitTrack to optimal and get
  // the final chisquare and path length.

  double fchisq = 0.;
  path = 0.;
  if(trg.isValid()) {
    path = trg.endTrack().getPath() - trg.startTrack().getPath();
    if(dir == Propagator::FORWARD) {
      trg.endTrack().setStat(KFitTrack::OPTIMAL);
      fchisq = trg.endTrack().getChisq();
    }
    else {
      trg.startTrack().setStat(KFitTrack::OPTIMAL);
      fchisq = trg.startTrack().getChisq();
    }
  }

  // Summary.

  log << "KalmanFilterAlg build track summary.\n"
      << "Build direction = " << (dir == Propagator::FORWARD ? "FORWARD" : "BACKWARD") << "\n"
      << "Track has " << trg.numHits() << " hits.\n"
      << "Track length = " << path << "\n"
      << "Track chisquare = " << fchisq << "\n";
  // log << trg << "\n";

  // Done.  Return success if we added at least one measurement.

  bool ok = trg.numHits() > 0;

  if(fGTrace && fCanvases.size() > 0) {
    TText* t = 0;
    if(ok)
      t = fMessages->AddText("Exit buildTrack, status success");
    else
      t = fMessages->AddText("Exit buildTrack, status fail");
    t->SetBit(kCanDelete);
    fInfoPad->Modified();
    fCanvases.back()->Update();
  }

  return ok;
}

void trkf::KalmanFilterAlg::cleanTrack

(

KGTrack &

trg

)

const

Clean track by removing noise hits near endpoints.

Clean track by removing noise hits near endpoints.

Arguments:

trg - Track.

Definition at line 2214 of file KalmanFilterAlg.cxx.

References fCanvases, fGapDist, fGTrace, fMarkerMap, fMaxEndChisq, fMaxNoiseHits, trkf::KHitBase::getChisq(), trkf::KHitTrack::getHit(), trkf::KHitBase::getID(), trkf::KHitBase::getMeasPlane(), and trkf::KGTrack::getTrackMap().

Referenced by buildTrack(), extendTrack(), and setPlane().

{
  // Get hold of a modifiable track map from trg.

  std::multimap<double, KHitTrack>& trackmap = trg.getTrackMap();

  // Do an indefinite loop until we no longer find any dirt.

  bool done = false;
  while(!done) {

    // If track map has fewer than fMaxNoiseHits tracks, then this is a
    // noise track.  Clear the map, making the whole track invalid.

    int ntrack = trackmap.size();
    if(ntrack <= fMaxNoiseHits) {
      for(auto const& trackmap_entry : trackmap) {
        const KHitTrack& trh = trackmap_entry.second;
        const KHitBase& hit = *(trh.getHit());
        auto marker_it = fMarkerMap.find(hit.getID());
        if(marker_it != fMarkerMap.end()) {
          TMarker* marker = marker_it->second;
          marker->SetMarkerColor(kGreen);
        }
      }
      trackmap.clear();
      done = true;
      break;
    }

    // Make sure the first two and last two tracks belong to different
    // views.  If not, remove the first or last track.

    if(ntrack >= 2) {

      // Check start.

      std::multimap<double, KHitTrack>::iterator it = trackmap.begin();
      const KHitTrack& trh1a = (*it).second;
      const KHitBase& hit1a = *(trh1a.getHit());
      int plane1 = hit1a.getMeasPlane();
      double chisq1 = hit1a.getChisq();
      ++it;
      const KHitTrack& trh2a = (*it).second;
      const KHitBase& hit2a = *(trh2a.getHit());
      int plane2 = hit2a.getMeasPlane();
      double chisq2 = hit2a.getChisq();
      if((plane1 >= 0 && plane2 >= 0 && plane1 == plane2) ||
         chisq1 > fMaxEndChisq || chisq2 > fMaxEndChisq) {
        auto marker_it = fMarkerMap.find(hit1a.getID());
        if(marker_it != fMarkerMap.end()) {
          TMarker* marker = marker_it->second;
          marker->SetMarkerColor(kGreen);
        }
        trackmap.erase(trackmap.begin(), it);
        done = false;
        continue;
      }

      // Check end.

      it = trackmap.end();
      --it;
      const KHitTrack& trh1b = (*it).second;
      const KHitBase& hit1b = *(trh1b.getHit());
      plane1 = hit1b.getMeasPlane();
      chisq1 = hit1b.getChisq();
      --it;
      const KHitTrack& trh2b = (*it).second;
      const KHitBase& hit2b = *(trh2b.getHit());
      plane2 = hit2b.getMeasPlane();
      chisq2 = hit2b.getChisq();
      if((plane1 >= 0 && plane2 >= 0 && plane1 == plane2) ||
         chisq1 > fMaxEndChisq || chisq2 > fMaxEndChisq) {
        ++it;
        auto marker_it = fMarkerMap.find(hit1b.getID());
        if(marker_it != fMarkerMap.end()) {
          TMarker* marker = marker_it->second;
          marker->SetMarkerColor(kGreen);
        }
        trackmap.erase(it, trackmap.end());
        done = false;
        continue;
      }
    }

    // Loop over successive pairs of elements of track map.  Look for
    // adjacent elements with distance separation greater than
    // fGapDist.

    std::multimap<double, KHitTrack>::iterator it = trackmap.begin();
    std::multimap<double, KHitTrack>::iterator jt = trackmap.end();
    int nb = 0;                // Number of elements from begin to jt.
    int ne = ntrack;           // Number of elements it to end.
    bool found_noise = false;
    for(; it != trackmap.end(); ++it, ++nb, --ne) {
      if(jt == trackmap.end())
        jt = trackmap.begin();
      else {
        if (nb < 1)
          throw cet::exception("KalmanFilterAlg") << "KalmanFilterAlg::cleanTrack(): nb not positive\n";
        if (ne < 1)
          throw cet::exception("KalmanFilterAlg") << "KalmanFilterAlg::cleanTrack(): ne not positive\n";
        
        double disti = (*it).first;
        double distj = (*jt).first;
        double sep = disti - distj;
        if (sep < 0.)
          throw cet::exception("KalmanFilterAlg") << "KalmanFilterAlg::fitMomentumRange(): negative separation\n";

        if(sep > fGapDist) {

          // Found a gap.  See if we want to trim track.

          if(nb <= fMaxNoiseHits) {

            // Trim front.

            found_noise = true;
            for(auto jt = trackmap.begin(); jt != it; ++jt) {
              const KHitTrack& trh = jt->second;
              const KHitBase& hit = *(trh.getHit());
              auto marker_it = fMarkerMap.find(hit.getID());
              if(marker_it != fMarkerMap.end()) {
                TMarker* marker = marker_it->second;
                marker->SetMarkerColor(kGreen);
              }
            }
            trackmap.erase(trackmap.begin(), it);
            break;
          }
          if(ne <= fMaxNoiseHits) {

            // Trim back.

            found_noise = true;
            for(auto jt = it; jt != trackmap.end(); ++jt) {
              const KHitTrack& trh = jt->second;
              const KHitBase& hit = *(trh.getHit());
              auto marker_it = fMarkerMap.find(hit.getID());
              if(marker_it != fMarkerMap.end()) {
                TMarker* marker = marker_it->second;
                marker->SetMarkerColor(kGreen);
              }
            }
            trackmap.erase(it, trackmap.end());
            break;
          }
        }
        ++jt;
      }
    }

    // Decide if we are done.

    done = !found_noise;
  }
  if(fGTrace && fCanvases.size() > 0)
    fCanvases.back()->Update();
}

bool trkf::KalmanFilterAlg::extendTrack	(	KGTrack &	trg,
		const Propagator *	prop,
		KHitContainer &	hits
	)		const

Add hits to existing track.

Add hits to existing track.

Arguments:

trg - Track to extend. prop - Propagator. hits - Hit collection to choose hits from.

This method extends a KGTrack by adding hits. The KGTrack must have previously been produced by a unidirectional Kalman fit (it should be optimal at one end). This method finds the optimal end and extends the track in that direction. If any hits are added, the originally optimal end has its status reset to forward or backward, and the new endpoint is optimal. In any case, the final result is unidirectionally fit KGTrack.

Definition at line 1223 of file KalmanFilterAlg.cxx.

References trkf::KGTrack::addTrack(), trkf::KFitTrack::BACKWARD, trkf::Propagator::BACKWARD, trkf::KFitTrack::BACKWARD_PREDICTED, cleanTrack(), dir, trkf::KGTrack::endTrack(), fCanvases, fGTrace, fInfoPad, fMarkerMap, fMaxIncChisq, fMaxPErr, fMaxPredDist, fMaxPropDist, fMaxSamePlane, fMaxSortDist, fMessages, trkf::KFitTrack::FORWARD, trkf::Propagator::FORWARD, trkf::KFitTrack::FORWARD_PREDICTED, fPads, fPlane, fTrace, trkf::KFitTrack::getChisq(), trkf::KHitBase::getChisq(), trkf::KETrack::getError(), trkf::KHitGroup::getHits(), trkf::KHitBase::getID(), trkf::KHitBase::getMeasPlane(), trkf::KHitGroup::getPath(), trkf::KFitTrack::getPath(), trkf::KHitGroup::getPlane(), trkf::KHitBase::getPredDistance(), trkf::KHitContainer::getSorted(), trkf::KFitTrack::getStat(), trkf::KHitGroup::getSurface(), trkf::KTrack::getSurface(), trkf::KHitContainer::getUnsorted(), trkf::KHitContainer::getUnused(), trkf::KTrack::getVector(), trkf::KGTrack::isValid(), trkf::KTrack::isValid(), trkf::Propagator::noise_prop(), trkf::KGTrack::numHits(), trkf::KFitTrack::OPTIMAL, trkf::KETrack::PointingError(), trkf::KHitBase::predict(), trkf::KFitTrack::setChisq(), trkf::KFitTrack::setPath(), trkf::KFitTrack::setStat(), trkf::KHitContainer::sort(), trkf::KGTrack::startTrack(), trkf::Propagator::UNKNOWN, and lar::dump::vector().

Referenced by trkf::Track3DKalmanHitAlg::extendandsmoothLoop(), and setPlane().

{
  if (!prop)
    throw cet::exception("KalmanFilterAlg") << "trkf::KalmanFilterAlg::extendTrack(): no propagator\n";

  // Default result failure.

  bool result = false;

  if(fGTrace && fCanvases.size() > 0) {
    TText* t = fMessages->AddText("Enter extendTrack");
    t->SetBit(kCanDelete);
    fInfoPad->Modified();
    fCanvases.back()->Update();
  }

  // Remember the original number of measurement.

  unsigned int nhits0 = trg.numHits();

  // It is an error if the KGTrack is not valid.

  if(trg.isValid()) {
    mf::LogInfo log("KalmanFilterAlg");

    // Examine the track endpoints and figure out which end of the
    // track to extend.  The track is always extended from the optimal
    // end.  It is an error if neither end point is optimal, or both
    // endoints are optimal.  Reset the status of the optimal, and
    // make a copy of the starting track fit.  Also get starting path
    // and chisquare.

    KHitTrack& trh0 = trg.startTrack();
    KHitTrack& trh1 = trg.endTrack();
    KFitTrack::FitStatus stat0 = trh0.getStat();
    KFitTrack::FitStatus stat1 = trh1.getStat();
    bool dofit = false;
    Propagator::PropDirection dir = Propagator::UNKNOWN;
    KFitTrack trf;
    double path = 0.;
    double tchisq = 0.;

    if(stat0 == KFitTrack::OPTIMAL) {
      if(stat1 == KFitTrack::OPTIMAL) {

        // Both ends optimal (do nothing, return failure).

        dofit = false;
        result = false;
        return result;
      }
      else {

        // Start optimal.  Extend backward.

        dofit = true;
        dir = Propagator::BACKWARD;
        trh0.setStat(KFitTrack::BACKWARD);
        trf = trh0;
        path = trh0.getPath();
        tchisq = trh0.getChisq();
      }
    }
    else {
      if(stat1 == KFitTrack::OPTIMAL) {

        // End optimal.  Extend forward.

        dofit = true;
        dir = Propagator::FORWARD;
        trh1.setStat(KFitTrack::FORWARD);
        trf = trh1;
        path = trh1.getPath();
        tchisq = trh1.getChisq();

        // Make sure forward extend track momentum is over some
        // minimum value.

        if(trf.getVector()(4) > 5.) {
          trf.getVector()(4) = 5.;
          trf.getError()(4,4) = 5.;
        }
      }
      else {

        // Neither end optimal (do nothing, return failure).

        dofit = false;
        result = false;
        return result;
      }
    }
    if(dofit) {

      // Sort hit container using starting track.

      hits.sort(trf, true, prop, dir);

      // Draw and add hits in hit->marker map that are not already there.

      if(fGTrace && fCanvases.size() > 0) {

        // Loop over sorted KHitGroups.
        // Paint sorted hits black.

        const std::list<KHitGroup>& groups = hits.getSorted();
        for(auto const& gr : groups) {

          // Loop over hits in this group.

          const std::vector<std::shared_ptr<const KHitBase> >& phits = gr.getHits();
          for(auto const& phit : phits) {
            const KHitBase& hit = *phit;
            int pl = hit.getMeasPlane();
            if(pl >= 0 && pl < int(fPads.size())) {

              // Is this hit already in map?

              TMarker* marker = 0;
              auto marker_it = fMarkerMap.find(hit.getID());
              if(marker_it == fMarkerMap.end()) {
                double z = 0.;
                double x = 0.;
                hit_position(hit, z, x);
                marker = new TMarker(z, x, 20);
                fMarkerMap[hit.getID()] = marker;
                fPads[pl]->cd();
                marker->SetBit(kCanDelete);   // Give away ownership.
                marker->SetMarkerSize(0.5);
                marker->Draw();
              }
              else
                marker = marker_it->second;
              marker->SetMarkerColor(kBlack);
            }
          }
        }

        // Loop over unsorted KHitGroups.
        // Paint unsorted hits blue.

        const std::list<KHitGroup>& ugroups = hits.getUnsorted();
        for(auto const& gr : ugroups) {

          // Loop over hits in this group.

          const std::vector<std::shared_ptr<const KHitBase> >& phits = gr.getHits();
          for(auto const& phit : phits) {
            const KHitBase& hit = *phit;
            int pl = hit.getMeasPlane();
            if(pl >= 0 && pl < int(fPads.size())) {

              // Is this hit already in map?

              TMarker* marker = 0;
              auto marker_it = fMarkerMap.find(hit.getID());
              if(marker_it == fMarkerMap.end()) {
                double z = 0.;
                double x = 0.;
                hit_position(hit, z, x);
                marker = new TMarker(z, x, 20);
                fMarkerMap[hit.getID()] = marker;
                fPads[pl]->cd();
                marker->SetBit(kCanDelete);   // Give away ownership.
                marker->SetMarkerSize(0.5);
                marker->Draw();
              }
              else
                marker = marker_it->second;
              marker->SetMarkerColor(kBlue);
            }
          }
        }
        fCanvases.back()->Update();
      }

      //std::cout << "extendTrack: marker map has " << fMarkerMap.size() << " entries." << std::endl;

      // Extend loop starts here.

      int step = 0;
      int nsame = 0;
      int last_plane = -1;
      while(hits.getSorted().size() > 0) {
        ++step;
        if(fTrace) {
          log << "Extend Step " << step << "\n";
          log << "KGTrack has " << trg.numHits() << " hits.\n";
          log << trf;
        }

        // Get an iterator for the next KHitGroup.

        std::list<KHitGroup>::iterator it;
        switch (dir) {
          case Propagator::FORWARD:
            it = hits.getSorted().begin();
            break;
          case Propagator::BACKWARD:
            it = hits.getSorted().end();
            --it;
            break;
          default:
            throw cet::exception("KalmanFilterAlg") << "KalmanFilterAlg::extendTrack(): invalid direction\n";
        } // switch
        const KHitGroup& gr = *it;

        if(fTrace) {
          double path_est = gr.getPath();
          log << "Next surface: " << *(gr.getSurface()) << "\n";
          log << "  Estimated path length of hit group = " << path_est << "\n";
        }

        // Get the next prediction surface.  If this KHitGroup is on the
        // preferred plane, use that as the prediction surface.
        // Otherwise, use the current track surface as the prediction
        // surface.

        std::shared_ptr<const Surface> psurf = trf.getSurface();
        if (gr.getPlane() < 0)
          throw cet::exception("KalmanFilterAlg") << "KalmanFilterAlg::extendTrack(): negative plane?\n";
        if(fPlane < 0 || gr.getPlane() < 0 || fPlane == gr.getPlane())
          psurf = gr.getSurface();

        // Propagate track to the prediction surface.

        boost::optional<double> dist = prop->noise_prop(trf, psurf, Propagator::UNKNOWN, true);
        if(!!dist && std::abs(*dist) > fMaxPropDist)
          dist = boost::optional<double>(false, 0.);
        double ds = 0.;

        if(!!dist) {

          // Propagation succeeded.
          // Update cumulative path distance and track status.

          ds = *dist;
          path += ds;
          trf.setPath(path);
          if(dir == Propagator::FORWARD)
            trf.setStat(KFitTrack::FORWARD_PREDICTED);
          else {
            trf.setStat(KFitTrack::BACKWARD_PREDICTED);
          }
          if(fTrace) {
            log << "After propagation\n";
            log << "  Incremental distance = " << ds << "\n";
            log << "  Track path length = " << path << "\n";
            log << "KGTrack has " << trg.numHits() << " hits.\n";
            log << trf;
          }

          // Loop over measurements in this group.

          const std::vector<std::shared_ptr<const KHitBase> >& hits = gr.getHits();
          double best_chisq = 0.;
          std::shared_ptr<const KHitBase> best_hit;
          for(std::vector<std::shared_ptr<const KHitBase> >::const_iterator ihit = hits.begin();
              ihit != hits.end(); ++ihit) {
            const KHitBase& hit = **ihit;

            // Turn this hit blue.

            if(fGTrace && fCanvases.size() > 0) {
              auto marker_it = fMarkerMap.find(hit.getID());
              if(marker_it != fMarkerMap.end()) {
                TMarker* marker = marker_it->second;
                marker->SetMarkerColor(kBlue);
              }
              //fCanvases.back()->Update();
            }

            // Update predction using current track hypothesis and get
            // incremental chisquare.

            bool ok = hit.predict(trf, prop);
            if(ok) {
              double chisq = hit.getChisq();
              double preddist = hit.getPredDistance();
              if(abs(preddist) < fMaxPredDist &&
                 (best_hit.get() == 0 || chisq < best_chisq)) {
                best_chisq = chisq;
                if(chisq < fMaxIncChisq)
                  best_hit = *ihit;
              }
            }
          }
          if(fTrace) {
            log << "Best hit incremental chisquare = " << best_chisq << "\n";
            if(best_hit.get() != 0) {
              log << "Hit after prediction\n";
              log << *best_hit;
            }
            else
              log << "No hit passed chisquare cut.\n";
          }
          if(fGTrace && fCanvases.size() > 0)
            fCanvases.back()->Update();

          // If we found a best measurement, and if the incremental
          // chisquare passes the cut, add it to the track and update 
          // fit information.

          bool update_ok = false;
          if(best_hit.get() != 0) {
            KFitTrack trf0(trf);
            best_hit->update(trf);
            update_ok = trf.isValid();
            if(!update_ok)
              trf = trf0;
          }
          if(update_ok) {
            ds += best_hit->getPredDistance();
            tchisq += best_chisq;
            trf.setChisq(tchisq);
            if(dir == Propagator::FORWARD)
              trf.setStat(KFitTrack::FORWARD);
            else {
              trf.setStat(KFitTrack::BACKWARD);
            }

            // If the pointing error got too large, quit.

            if(trf.PointingError() > fMaxPErr) {
              if(fTrace)
                log << "Quitting because pointing error got too large.\n";
              break;
            }

            // Test number of consecutive measurements in the same plane.

            if(gr.getPlane() >= 0) {
              if(gr.getPlane() == last_plane)
                ++nsame;
              else {
                nsame = 1;
                last_plane = gr.getPlane();
              }
            }
            else {
              nsame = 0;
              last_plane = -1;
            }
            if(nsame <= fMaxSamePlane) {

              // Turn best hit red.

              if(fGTrace && fCanvases.size() > 0) {
                int pl = best_hit->getMeasPlane();
                if(pl >= 0 && pl < int(fPads.size())) {
                  auto marker_it = fMarkerMap.find(best_hit->getID());
                  if(marker_it != fMarkerMap.end()) {
                    TMarker* marker = marker_it->second;
                    marker->SetMarkerColor(kRed);

                    // Redraw marker so that it will be on top.

                    fPads[pl]->cd();
                    marker->Draw();
                  }
                }
                fCanvases.back()->Update();
              }

              // Make a KHitTrack and add it to the KGTrack.

              KHitTrack trh(trf, best_hit);
              trg.addTrack(trh);

              if(fTrace) {
                log << "After update\n";
                log << "KGTrack has " << trg.numHits() << " hits.\n";
                log << trf;
              }
            }
          }
        }

        // The current KHitGroup is now resolved.
        // Move it to unused list.

        hits.getUnused().splice(hits.getUnused().end(), hits.getSorted(), it);

        // If the propagation distance was the wrong direction, resort the measurements.

        if(!!dist &&
           ((dir == Propagator::FORWARD && (ds < fMinSortDist || ds > fMaxSortDist)) ||
            (dir == Propagator::BACKWARD && (-ds < fMinSortDist || -ds > fMaxSortDist)))) {
          if(fTrace)
            log << "Resorting measurements.\n";
          hits.sort(trf, true, prop, dir);
        }
      }
    }

    // Clean track.

    cleanTrack(trg);

    // Set the fit status of the last added KHitTrack to optimal and
    // get the final chisquare and path length.

    double fchisq = 0.;
    path = 0.;
    if(trg.isValid()) {
      path = trg.endTrack().getPath() - trg.startTrack().getPath();
      switch (dir) {
        case Propagator::FORWARD:
          trg.endTrack().setStat(KFitTrack::OPTIMAL);
          fchisq = trg.endTrack().getChisq();
          break;
        case Propagator::BACKWARD:
          trg.startTrack().setStat(KFitTrack::OPTIMAL);
          fchisq = trg.startTrack().getChisq();
          break;
        default:
          throw cet::exception("KalmanFilterAlg") << "KalmanFilterAlg::extendTrack(): invalid direction [II]\n";
      } // switch
    }

    // Summary.

    log << "KalmanFilterAlg extend track summary.\n"
        << "Extend direction = " << (dir == Propagator::FORWARD ? "FORWARD" : "BACKWARD") << "\n"
        << "Track has " << trg.numHits() << " hits.\n"
        << "Track length = " << path << "\n"
        << "Track chisquare = " << fchisq << "\n";
    // log << trg << "\n";
  }

  // Done.

  result = (trg.numHits() > nhits0);

  if(fGTrace && fCanvases.size() > 0) {
    TText* t = 0;
    if(result)
      t = fMessages->AddText("Exit extendTrack, status success");
    else
      t = fMessages->AddText("Exit extendTrack, status fail");
    t->SetBit(kCanDelete);
    fInfoPad->Modified();
    fCanvases.back()->Update();
  }

  return result;
}

bool trkf::KalmanFilterAlg::fitMomentum	(	const KGTrack &	trg,
		const Propagator *	prop,
		KETrack &	tremom
	)		const

Estimate track momentum using either range or multiple scattering.

Estimate track momentum using either range or multiple scattering.

Arguments:

trg - Global track whose momentum is to be updated. prop - Propagator. tremom - Track with momentum estimate.

Returns: True if success.

Definition at line 1947 of file KalmanFilterAlg.cxx.

References fFitMomMS, fFitMomRange, fitMomentumMS(), fitMomentumRange(), trkf::KETrack::getError(), trkf::KTrack::getVector(), trkf::KGTrack::startTrack(), and updateMomentum().

Referenced by trkf::Track3DKalmanHitAlg::fitnupdateMomentum(), trkf::TrackKalmanCheater::produce(), and setPlane().

{
  mf::LogInfo log("KalmanFilterAlg");
  double invp_range = 0.;
  double invp_ms = 0.;

  // Get multiple scattering momentum estimate.

  KETrack tremom_ms;
  bool ok_ms = false;
  if(fFitMomMS) {
    ok_ms = fitMomentumMS(trg, prop, tremom_ms);
    if(ok_ms) {
      KGTrack trg_ms(trg);
      ok_ms = updateMomentum(tremom_ms, prop, trg_ms);
      if(ok_ms) {
        invp_ms = trg_ms.startTrack().getVector()(4);
        double var_invp = trg_ms.startTrack().getError()(4,4);
        double p = 0.;
        if(invp_ms != 0.)
          p = 1./invp_ms;
        double err_p = p*p * std::sqrt(var_invp);
        log << "Multiple scattering momentum estimate = " << p << "+-" << err_p << "\n";
      }
    }
  }

  // Get range momentum estimate.

  KETrack tremom_range;
  bool ok_range = false;
  if(fFitMomRange) {
    ok_range = fitMomentumRange(trg, prop, tremom_range);
    if(ok_range) {
      KGTrack trg_range(trg);
      ok_range = updateMomentum(tremom_range, prop, trg_range);
      if(ok_range) {
        invp_range = trg_range.startTrack().getVector()(4);
        double var_invp = trg_range.startTrack().getError()(4,4);
        double p = 0.;
        if(invp_range != 0.)
          p = 1./invp_range;
        double err_p = p*p * std::sqrt(var_invp);
        log << "Range momentum estimate               = " << p << "+-" << err_p << "\n";
      }
    }
  }

  bool result = false;
  if(ok_range) {
    tremom = tremom_range;
    result = ok_range;
  }
  else if(ok_ms) {
    tremom = tremom_ms;
    result = ok_ms;
  }
  return result;
}

bool trkf::KalmanFilterAlg::fitMomentumMS	(	const KGTrack &	trg,
		const Propagator *	prop,
		KETrack &	tremom
	)		const

Estimate track momentum using multiple scattering.

Estimate track momentum using multiple scattering.

Arguments:

trg - Global track. prop - Propagator. tremom - Track containing momentum estimate.

Returns: True if success.

This method estimates the momentum of the specified track using multiple scattering. As a result of calling this method, the original global track is not updated, but a KETrack is produced near the starting surface that has the estimated momentum.

The global track passed as argument should have been smoothed prior to calling this method so that all or most fits are optimal. If either the first or last fit is not optimal, return false.

This method assumes that track parameter four is 1/p. This sort of momentum estimation only makes sense if the momentum track parameter is uncorrelated with any other track parameter. The error matrix of the first and last fit is checked for this. If it is found that either error matrix has correlated track parameter four with any other track parameter, this method returns without doing anything (return false).

Definition at line 1742 of file KalmanFilterAlg.cxx.

References beta, trkf::Propagator::err_prop(), fMinSampleDist, trkf::KETrack::getError(), trkf::KFitTrack::getStat(), trkf::KTrack::getSurface(), trkf::KGTrack::getTrackMap(), trkf::KTrack::getVector(), trkf::KTrack::Mass(), trkf::Propagator::noise_prop(), trkf::KFitTrack::OPTIMAL, s, trkf::Propagator::UNKNOWN, and trkf::Propagator::vec_prop().

Referenced by fitMomentum(), and setPlane().

{
  // Get iterators pointing to the first and last tracks.

  const std::multimap<double, KHitTrack>& trackmap = trg.getTrackMap();
  if(trackmap.size() < 2)
    return false;
  std::multimap<double, KHitTrack>::const_iterator itend[2];
  itend[0] = trackmap.begin();
  itend[1] = trackmap.end();
  --itend[1];

  // Check the fit status and error matrix of the first and last
  // track.

  bool result = true;

  for(int i=0; result && i<2; ++i) {
    const KHitTrack& trh = itend[i]->second;
    KFitTrack::FitStatus stat = trh.getStat();
    if(stat != KFitTrack::OPTIMAL)
      result = false;
    const TrackError& err = trh.getError();
    for(int j=0; j<4; ++j) {
      if(err(4,j) != 0.)
        result = false;
    }
  }
  if(!result)
    return result;

  // We will periodically sample the track trajectory.  At each sample
  // point, collect the following information.
  //
  // 1.  The path distance at the sample point.
  // 2.  The original momentum of the track at the sample point and its error.
  // 3.  One copy of the track (KETrack) that will be propagated without noise
  //     (infinite momentum track).
  // 3.  A second copy of the track (KETrack) that will be propagated with the
  //     minimum allowed momentum (range out track).
  // 4.  A third copy of the track (KETrack) that will propagated with noise
  //     with some intermediate momentum (noise track).
  //
  // Collect the first sample from the maximum path distance track.

  double s_sample = itend[1]->first;
  const KETrack& tre = itend[1]->second;
  KETrack tre_inf(tre);
  KTrack trk_range(tre);
  KETrack tre_noise(tre);
  tre_inf.getVector()(4) = 0.;
  tre_inf.getError()(4,4) = 0.;
  trk_range.getVector()(4) = 100.;
  tre_noise.getError()(4,4) = 0.;
  tre_noise.getVector()(4) = 1.;
  tre_noise.getError()(4,4) = 10.;
  double invp0 = tre_noise.getVector()(4);
  double var_invp0 = tre_noise.getError()(4,4);

  // Loop over fits, starting at the high path distance (low momentum)
  // end.  

  for(std::multimap<double, KHitTrack>::const_reverse_iterator it = trackmap.rbegin();
      it != trackmap.rend(); ++it) {
    double s = it->first;
    const KHitTrack& trh = it->second;

    // Ignore non-optimal fits.

    KFitTrack::FitStatus stat = trh.getStat();
    if(stat != KFitTrack::OPTIMAL)
      continue;

    // See if this track is far enough from the previous sample to
    // make a new sample point.

    if(std::abs(s - s_sample) > fMinSampleDist) {

      // Propagate tracks to the current track surface.

      std::shared_ptr<const Surface> psurf = trh.getSurface();
      boost::optional<double> dist_inf = prop->err_prop(tre_inf, psurf,
                                                        Propagator::UNKNOWN, false);
      boost::optional<double> dist_range = prop->vec_prop(trk_range, psurf,
                                                          Propagator::UNKNOWN, false);
      boost::optional<double> dist_noise = prop->noise_prop(tre_noise, psurf,
                                                            Propagator::UNKNOWN, true);

      // All propagations should normally succeed.  If they don't,
      // ignore this sample for the purpose of updating the momentum.

      bool momentum_updated = false;
      if(!!dist_inf && !!dist_range && !!dist_noise) {

        // Extract the momentum at the new sample point.

        double invp1 = tre_noise.getVector()(4);
        double var_invp1 = tre_noise.getError()(4,4);

        // Get the average momentum and error for this pair of
        // sample points, and other data.

        double invp = 0.5 * (invp0 + invp1);
        double var_invp = 0.5 * (var_invp0 + var_invp1);
        double mass = tre_inf.Mass();
        double beta = std::sqrt(1. + mass*mass*invp*invp);
        double invbp = invp / beta;

        // Extract slope subvectors and sub-error-matrices.
        // We have the following variables.
        //
        // slope0 - Predicted slope vector (from infinite momentum track).
        // slope1 - Measured slope vector (from new sample point).
        // defl - Deflection (slope residual = difference between measured 
        //        and predicted slope vector).
        // err0 - Slope error matrix of prediction.
        // err1 - Slope error matrix of measurement
        // errc - Slope residual error matrix = err0 + err1.
        // errn - Noise slope error matrix divided by (1/beta*momentum).

        KVector<2>::type slope0 = project(tre_inf.getVector(), ublas::range(2, 4));
        KVector<2>::type slope1 = project(trh.getVector(), ublas::range(2, 4));
        KVector<2>::type defl = slope1 - slope0;
        KSymMatrix<2>::type err0 =
          project(tre_inf.getError(), ublas::range(2, 4), ublas::range(2, 4));
        KSymMatrix<2>::type err1 =
          project(trh.getError(), ublas::range(2, 4), ublas::range(2, 4));
        KSymMatrix<2>::type errc = err0 + err1;
        KSymMatrix<2>::type errn =
          project(tre_noise.getError(), ublas::range(2, 4), ublas::range(2, 4));
        errn -= err0;
        errn /= invbp;

        // Calculate updated average momentum and error.

        double new_invp = invp;
        double new_var_invp = var_invp;
        update_momentum(defl, errc, errn, mass, new_invp, new_var_invp);

        // Calculate updated momentum and error at the second sample
        // point.

        double dp = 1./new_invp - 1./invp;
        invp0 = 1./(1./invp1 + dp);
        var_invp0 = new_var_invp;
        momentum_updated = true;

        // Make sure that updated momentum is not less than minimum
        // allowed momentum.

        double invp_range = trk_range.getVector()(4);
        if(invp0 > invp_range)
          invp0 = invp_range;
      }

      // Update sample.

      if(momentum_updated) {
        s_sample = s;
        tre_inf = trh;
        tre_inf.getVector()(4) = 0.;
        tre_inf.getError()(4,4) = 0.;
        double invp_range = trk_range.getVector()(4);
        trk_range = trh;
        trk_range.getVector()(4) = invp_range;
        tre_noise = trh;
        tre_noise.getVector()(4) = invp0;
        tre_noise.getError()(4,4) = var_invp0;
      }
    }
  }

  // Propagate noise track to starting (high momentum) track surface
  // to get final starting momentum.  This propagation should normally
  // always succeed, but if it doesn't, don't update the track.

  const KHitTrack& trh0 = itend[0]->second;
  std::shared_ptr<const Surface> psurf = trh0.getSurface();
  boost::optional<double> dist_noise = prop->noise_prop(tre_noise, psurf,
                                                        Propagator::UNKNOWN, true);
  result = !!dist_noise;

  // Update momentum-estimating track.

  mf::LogInfo log("KalmanFilterAlg");
  if(result)
    tremom = tre_noise;

  // Done.

  return result;
}

bool trkf::KalmanFilterAlg::fitMomentumRange	(	const KGTrack &	trg,
		const Propagator *	prop,
		KETrack &	tremom
	)		const

Estimate track momentum using range.

Estimate track momentum using range.

Arguments:

trg - Global track. prop - Propagator. tremom - Track with momentum estimate.

Returns: True if success.

This method generates a momentum-estimating track by extracting the last track from a global track, and setting its momentum to some small value.

Definition at line 1687 of file KalmanFilterAlg.cxx.

References trkf::KGTrack::endTrack(), trkf::KETrack::getError(), trkf::KFitTrack::getStat(), trkf::KTrack::getVector(), trkf::KFitTrack::INVALID, and trkf::KGTrack::isValid().

Referenced by fitMomentum(), and setPlane().

{
  if(!trg.isValid())
    return false;

  // Extract track with lowest momentum.

  const KHitTrack& trh = trg.endTrack();
  if (trh.getStat() == KFitTrack::INVALID)
    throw cet::exception("KalmanFilterAlg") << "KalmanFilterAlg::fitMomentumRange(): invalid end track\n";
  tremom = trh;

  // Set track momentum to a small value.

  tremom.getVector()(4) = 100.;
  tremom.getError()(4,0) = 0.;
  tremom.getError()(4,1) = 0.;
  tremom.getError()(4,2) = 0.;
  tremom.getError()(4,3) = 0.;
  tremom.getError()(4,4) = 10000.;

  // Done.

  return true;
}

int trkf::KalmanFilterAlg::getPlane ( ) const

inline

Preferred view plane.

Definition at line 72 of file KalmanFilterAlg.h.

References fPlane.

bool trkf::KalmanFilterAlg::getTrace ( ) const

inline

Trace config parameters.

Definition at line 71 of file KalmanFilterAlg.h.

References fTrace.

void trkf::KalmanFilterAlg::reconfigure

(

const fhicl::ParameterSet &

pset

)

Reconfigure method.

Definition at line 269 of file KalmanFilterAlg.cxx.

References fFitMomMS, fFitMomRange, fGapDist, fGoodPErr, fGTrace, fGTraceWH, fGTraceWW, fGTraceXMax, fGTraceXMin, fGTraceZMax, fGTraceZMin, fMaxEndChisq, fMaxIncChisq, fMaxLDist, fMaxNoiseHits, fMaxPErr, fMaxPredDist, fMaxPropDist, fMaxSamePlane, fMaxSeedIncChisq, fMaxSeedPredDist, fMaxSmoothIncChisq, fMaxSortDist, fMinLHits, fMinSampleDist, fMinSortDist, fTrace, and fhicl::ParameterSet::get().

Referenced by KalmanFilterAlg(), trkf::TrackKalmanCheater::reconfigure(), and trkf::Track3DKalmanHitAlg::reconfigure().

{
  fTrace = pset.get<bool>("Trace");
  fMaxPErr = pset.get<double>("MaxPErr");
  fGoodPErr = pset.get<double>("GoodPErr");
  fMaxIncChisq = pset.get<double>("MaxIncChisq");
  fMaxSeedIncChisq = pset.get<double>("MaxSeedIncChisq");
  fMaxSmoothIncChisq = pset.get<double>("MaxSmoothIncChisq");
  fMaxEndChisq = pset.get<double>("MaxEndChisq");
  fMinLHits = pset.get<int>("MinLHits");
  fMaxLDist = pset.get<double>("MaxLDist");
  fMaxPredDist = pset.get<double>("MaxPredDist");
  fMaxSeedPredDist = pset.get<double>("MaxSeedPredDist");
  fMaxPropDist = pset.get<double>("MaxPropDist");
  fMinSortDist = pset.get<double>("MinSortDist");
  fMaxSortDist = pset.get<double>("MaxSortDist");
  fMaxSamePlane = pset.get<int>("MaxSamePlane");
  fGapDist = pset.get<double>("GapDist");
  fMaxNoiseHits = pset.get<double>("MaxNoiseHits");
  fMinSampleDist = pset.get<double>("MinSampleDist");
  fFitMomRange = pset.get<bool>("FitMomRange");
  fFitMomMS = pset.get<bool>("FitMomMS");
  fGTrace = pset.get<bool>("GTrace");
  if(fGTrace) {
    fGTraceWW = pset.get<double>("GTraceWW");
    fGTraceWH = pset.get<double>("GTraceWH");
    fGTraceXMin = pset.get<double>("GTraceXMin");
    fGTraceXMax = pset.get<double>("GTraceXMax");
    fGTraceZMin = pset.get<std::vector<double> >("GTraceZMin");
    fGTraceZMax = pset.get<std::vector<double> >("GTraceZMax");
  }
}

void trkf::KalmanFilterAlg::setPlane ( int  plane )

inline

Set preferred view plane.

Definition at line 77 of file KalmanFilterAlg.h.

References buildTrack(), cleanTrack(), dir, extendTrack(), fitMomentum(), fitMomentumMS(), fitMomentumRange(), fPlane, hits(), smoothTrack(), smoothTrackIter(), and updateMomentum().

Referenced by trkf::Track3DKalmanHitAlg::makeKalmanTracks(), and trkf::TrackKalmanCheater::produce().

void trkf::KalmanFilterAlg::setTrace ( bool  trace )

inline

Set trace config parameter.

Definition at line 76 of file KalmanFilterAlg.h.

References fTrace, and trkf::trace().

bool trkf::KalmanFilterAlg::smoothTrack	(	KGTrack &	trg,
		KGTrack *	trg1,
		const Propagator *	prop
	)		const

Smooth track.

Smooth track.

Arguments:

trg - Track to be smoothed. trg1 - Track to receive result of unidirectional fit. prop - Propagator.

Returns: True if success.

The starting track should be a global track that has been fit in one direction. Fit status should be optimal at (at least) one end. It is an error if the fit status is not optimal at either end. If the fit status is optimal at both ends, do nothing, but return success.

If the second argument is non-null, save the result of the unidirectional track fit produced as a byproduct of the smoothing operation. This track can be smoothed in order to iterate the Kalman fit, etc.

The Kalman smoothing algorithm starts at the optimal end and fits the track in the reverse direction, calculating optimal track parameters at each measurement surface.

All measurements are included in the reverse fit. No incremental chisquare cut is applied.

If any measurement surface can not be reached because of a measurement error, the entire smoothing operation is considered a failure. In that case, false is returned and the track is left in an undefined state.

Definition at line 882 of file KalmanFilterAlg.cxx.

References trkf::KGTrack::addTrack(), trkf::KFitTrack::BACKWARD, trkf::Propagator::BACKWARD, trkf::KFitTrack::BACKWARD_PREDICTED, trkf::KFitTrack::combineFit(), dir, trkf::KGTrack::endTrack(), fCanvases, fGTrace, fMarkerMap, fMaxSmoothIncChisq, trkf::KFitTrack::FORWARD, trkf::Propagator::FORWARD, trkf::KFitTrack::FORWARD_PREDICTED, fTrace, trkf::KFitTrack::getChisq(), trkf::KHitBase::getChisq(), trkf::KHitTrack::getHit(), trkf::KHitBase::getID(), trkf::KFitTrack::getPath(), trkf::KFitTrack::getStat(), trkf::KTrack::getSurface(), trkf::KGTrack::getTrackMap(), trkf::KGTrack::isValid(), trkf::KTrack::isValid(), trkf::Propagator::noise_prop(), trkf::KGTrack::numHits(), trkf::KFitTrack::OPTIMAL, trkf::KHitBase::predict(), trkf::KGTrack::recalibrate(), trkf::KFitTrack::setChisq(), trkf::KFitTrack::setPath(), trkf::KFitTrack::setStat(), trkf::KGTrack::startTrack(), trkf::Propagator::UNKNOWN, and trkf::KHitBase::update().

Referenced by trkf::Track3DKalmanHitAlg::extendandsmoothLoop(), setPlane(), trkf::Track3DKalmanHitAlg::smoothandextendTrack(), and smoothTrackIter().

{
  if (!prop)
    throw cet::exception("KalmanFilterAlg") << "trkf::KalmanFilterAlg::smoothTrack(): no propagator\n";

  // Default result failure.

  bool result = false;

  //if(fGTrace && fCanvases.size() > 0) {
  //  TText* t = fMessages->AddText("Enter smoothTrack");
  //  t->SetBit(kCanDelete);
  //  fInfoPad->Modified();
  //  fCanvases.back()->Update();
  // }

  // It is an error if the KGTrack is not valid.

  if(trg.isValid()) {

    // Examine the track endpoints and figure out which end of the track
    // to start from.  The fit always starts at the optimal end.  It is
    // an error if neither end point is optimal.  Do nothing and return
    // success if both end points are optimal.

    const KHitTrack& trh0 = trg.startTrack();
    const KHitTrack& trh1 = trg.endTrack();
    KFitTrack::FitStatus stat0 = trh0.getStat();
    KFitTrack::FitStatus stat1 = trh1.getStat();
    bool dofit = false;

    // Remember starting direction, track, and distance.

    Propagator::PropDirection dir = Propagator::UNKNOWN;
    const KTrack* trk = 0;
    double path = 0.;

    if(stat0 == KFitTrack::OPTIMAL) {
      if(stat1 == KFitTrack::OPTIMAL) {

        // Both ends optimal (do nothing, return success).

        dofit = false;
        result = true;

      }
      else {

        // Start optimal.

        dofit = true;
        dir = Propagator::FORWARD;
        trk = &trh0;
        path = 0.;
      }
    }
    else {
      if(stat1 == KFitTrack::OPTIMAL) {

        // End optimal.

        dofit = true;
        dir = Propagator::BACKWARD;
        trk = &trh1;
        path = trh1.getPath();
      }
      else {

        // Neither end optimal (do nothing, return failure).

        dofit = false;
        result = false;
      }
    }
    if(dofit) {
      if (!trk)
        throw cet::exception("KalmanFilterAlg") << "KalmanFilterAlg::smoothTrack(): no track!\n";

      // Cumulative chisquare.

      double tchisq = 0.;

      // Construct starting KFitTrack with track information and distance
      // taken from the optimal end, but with "infinite" errors.

      TrackError err;
      trk->getSurface()->getStartingError(err);
      KETrack tre(*trk, err);
      KFitTrack trf(tre, path, tchisq);

      // Make initial reference track to be same as initial fit track.

      KTrack ref(trf);

      // Loop over KHitTracks contained in KGTrack.

      std::multimap<double, KHitTrack>::iterator it;
      std::multimap<double, KHitTrack>::iterator itend;
      switch (dir) {
        case Propagator::FORWARD:
          it = trg.getTrackMap().begin();
          itend = trg.getTrackMap().end();
          break;
        case Propagator::BACKWARD:
          it = trg.getTrackMap().end();
          itend = trg.getTrackMap().begin();
          break;
        default:
          throw cet::exception("KalmanFilterAlg") << "KalmanFilterAlg::smoothTrack(): invalid direction\n";
      } // switch

      mf::LogInfo log("KalmanFilterAlg");

      // Loop starts here.

      result = true;             // Result success unless we find an error.
      int step = 0;              // Step count.
      while(dofit && it != itend) {
        ++step;
        if(fTrace) {
          log << "Smooth Step " << step << "\n";
          log << "Reverse fit track:\n";
          log << trf;
        }

        // For backward fit, decrement iterator at start of loop.

        if(dir == Propagator::BACKWARD)
          --it;

        KHitTrack& trh = (*it).second;
        if(fTrace) {
          log << "Forward track:\n";
          log << trh;
        }

        // Extract measurement.

        const KHitBase& hit = *(trh.getHit());

        // Propagate KFitTrack to the next track surface.
          
        std::shared_ptr<const Surface> psurf = trh.getSurface();
        boost::optional<double> dist = prop->noise_prop(trf, psurf, Propagator::UNKNOWN,
                                                        true, &ref);

        // Check if propagation succeeded.  If propagation fails, this
        // measurement will be dropped from the unidirectional fit
        // track.  This measurement will still be in the original
        // track, but with a status other than optimal.

        if(!!dist) {

          // Propagation succeeded.
          // Update cumulative path distance and track status.

          double ds = *dist;
          path += ds;
          trf.setPath(path);
          if(dir == Propagator::FORWARD)
            trf.setStat(KFitTrack::FORWARD_PREDICTED);
          else {
            trf.setStat(KFitTrack::BACKWARD_PREDICTED);
          }
          if(fTrace) {
            log << "Reverse fit track after propagation:\n";
            log << "  Propagation distance = " << ds << "\n";
            log << trf;
          }

          // See if we have the proper information to calculate an optimal track
          // at this surface (should normally be possible).

          KFitTrack::FitStatus stat = trh.getStat();
          KFitTrack::FitStatus newstat = trf.getStat();

          if((newstat == KFitTrack::FORWARD_PREDICTED && stat == KFitTrack::BACKWARD) ||
             (newstat == KFitTrack::BACKWARD_PREDICTED && stat == KFitTrack::FORWARD)) {

            // Update stored KHitTrack to be optimal.

            bool ok = trh.combineFit(trf);

            // Update the stored path distance to be from the currently fitting track.

            trh.setPath(trf.getPath());

            // Update reference track.

            ref = trh;

            // If combination failed, abandon the fit and return failure.

            if(!ok) {
              dofit = false;
              result = false;
              break;
            }
            if(fTrace) {
              log << "Combined track:\n";
              log << trh;
            }
          }

          // Update measurement predction using current track hypothesis.

          bool ok = hit.predict(trf, prop, &ref);
          if(!ok) {

            // If prediction failed, abandon the fit and return failure.

            dofit = false;
            result = false;
            break;
          }
          else {

            // Prediction succeeded.  Get incremental chisquare.  If
            // this hit fails incremental chisquare cut, this hit will
            // be dropped from the unidirecitonal Kalman fit track,
            // but may still be in the smoothed track.

            double chisq = hit.getChisq();
            if(chisq < fMaxSmoothIncChisq) {

              // Update the reverse fitting track using the current measurement
              // (both track parameters and status).

              KFitTrack trf0(trf);            
              hit.update(trf);
              bool update_ok = trf.isValid();
              if(!update_ok)
                trf = trf0;
              else {
                tchisq += chisq;
                trf.setChisq(tchisq);

                if(dir == Propagator::FORWARD)
                  trf.setStat(KFitTrack::FORWARD);
                else {
                  trf.setStat(KFitTrack::BACKWARD);
                }
                if(fTrace) {
                  log << "Reverse fit track after update:\n";
                  log << trf;
                }
                if(fGTrace && fCanvases.size() > 0) {
                  auto marker_it = fMarkerMap.find(hit.getID());
                  if(marker_it != fMarkerMap.end()) {
                    TMarker* marker = marker_it->second;
                    marker->SetMarkerColor(kOrange);
                  }
                  fCanvases.back()->Update();
                }

                // If unidirectional track pointer is not null, make a
                // KHitTrack and save it in the unidirectional track.

                if(trg1 != 0) {
                  KHitTrack trh1(trf, trh.getHit());
                  trg1->addTrack(trh1);
                }
              }
            }
          }
        }

        // For forward fit, increment iterator at end of loop.

        if(dir == Propagator::FORWARD)
          ++it;

      }    // Loop over KHitTracks.

      // If fit was successful and the unidirectional track pointer
      // is not null and the track is valid, set the fit status of
      // the last added KHitTrack to optimal.

      if(result && trg1 != 0 && trg1->isValid()) {
        if(dir == Propagator::FORWARD)
          trg1->endTrack().setStat(KFitTrack::OPTIMAL);
        else {
          trg1->startTrack().setStat(KFitTrack::OPTIMAL);
        }
      }

      // Recalibrate track map.

      trg.recalibrate();

    }      // Do fit.

    // Get the final chisquare.

    double fchisq = 0.5 * (trg.startTrack().getChisq() + trg.endTrack().getChisq());

    // Summary.

    mf::LogInfo log("KalmanFilterAlg");
    log << "KalmanFilterAlg smooth track summary.\n"
        << "Smooth direction = " << (dir == Propagator::FORWARD ? "FORWARD" : "BACKWARD") << "\n"
        << "Track has " << trg.numHits() << " hits.\n"
        << "Track length = " << trg.endTrack().getPath() - trg.startTrack().getPath() << "\n"
        << "Track chisquare = " << fchisq << "\n";
    // log << trg << "\n";
  }

  //if(fGTrace && fCanvases.size() > 0) {
  //  TText* t = 0;
  //  if(result)
  //    t = fMessages->AddText("Exit smoothTrack, status success");
  //  else
  //    t = fMessages->AddText("Exit smoothTrack, status fail");
  //  t->SetBit(kCanDelete);
  //  fInfoPad->Modified();
  //  fCanvases.back()->Update();
  // }

  // Done.

  return result;
}

bool trkf::KalmanFilterAlg::smoothTrackIter	(	int	nsmooth,
		KGTrack &	trg,
		const Propagator *	prop
	)		const

Iteratively smooth a track.

Iteratively smooth a track.

Arguments:

nsmooth - Number of iterations. trg - Track to be smoothed. prop - Propagator.

Returns: True if success.

The initial track should have been unidirectionally fit.

Definition at line 2182 of file KalmanFilterAlg.cxx.

References trkf::KGTrack::getPrefPlane(), and smoothTrack().

Referenced by trkf::TrackKalmanCheater::produce(), and setPlane().

{
  bool ok = true;

  // Call smoothTrack method in a loop.

  for(int ismooth = 0; ok && ismooth < nsmooth-1; ++ismooth) {
    KGTrack trg1(trg.getPrefPlane());
    ok = smoothTrack(trg, &trg1, prop);
    if(ok)
      trg = trg1;
  }

  // Do one final smooth without generating a new unidirectional
  // track.

  if(ok)
    ok = smoothTrack(trg, 0, prop);

  // Done.

  return ok;
}

bool trkf::KalmanFilterAlg::updateMomentum	(	const KETrack &	tremom,
		const Propagator *	prop,
		KGTrack &	trg
	)		const

Set track momentum at each track surface.

Set track momentum at each track surface.

Arguments:

tremom - Track containing momentum estimate. prop - Propagator. trg - Global track to be updated.

The track containing the momentum estimate is propagated to the first or last track fit of the global track (whichever is closer), then the momentum estimate is transfered to that track fit. In similar fashion, the momentum estimate is successively transfered from that track fit to each track fit of the global track.

Only momentum track parameters of the global track fits are updated. Other track parameters and their errors are unmodified. Unreachable track fits are deleted from the global track. Overall failure will occur if the momentum-estimating track can't be propagated to the initial track fit, or if the final global track has no valid track fits.

Definition at line 2030 of file KalmanFilterAlg.cxx.

References trkf::KETrack::getError(), trkf::KFitTrack::getStat(), trkf::KTrack::getSurface(), trkf::KGTrack::getTrackMap(), trkf::KTrack::getVector(), trkf::KFitTrack::INVALID, trkf::Propagator::noise_prop(), trkf::Propagator::UNKNOWN, and trkf::Propagator::vec_prop().

Referenced by fitMomentum(), trkf::Track3DKalmanHitAlg::fitnupdateMomentum(), trkf::TrackKalmanCheater::produce(), and setPlane().

{
  // Get modifiable track map.

  std::multimap<double, KHitTrack>& trackmap = trg.getTrackMap();

  // If track map is empty, immediately return failure.

  if(trackmap.size() == 0)
    return false;

  // Make trial propagations to the first and last track fit to figure
  // out which track fit is closer to the momentum estimating track.

  // Find distance to first track fit.
  
  KETrack tre0(tremom);
  boost::optional<double> dist0 = prop->vec_prop(tre0, trackmap.begin()->second.getSurface(),
                                                 Propagator::UNKNOWN, false, 0, 0);
  // Find distance to last track fit.
  
  KETrack tre1(tremom);
  boost::optional<double> dist1 = prop->vec_prop(tre1, trackmap.rbegin()->second.getSurface(),
                                                 Propagator::UNKNOWN, false, 0, 0);

  // Based on distances, make starting iterator and direction flag.

  bool forward = true;
  std::multimap<double, KHitTrack>::iterator it = trackmap.begin();
  if(!!dist0) {

    // Propagation to first track succeeded.

    if(!!dist1) {

      // Propagation to both ends succeeded.  If the last track is
      // closer, initialize iterator and direction flag for reverse
      // direction.

      if(std::abs(*dist0) > std::abs(*dist1)) {
        it = trackmap.end();
        --it;
        forward = false;
      }
    }
  }
  else {

    // Propagation to first track failed.  Initialize iterator and
    // direction flag for reverse direction, provided that the
    // propagation to the last track succeeded.

    if(!!dist1) {
      it = trackmap.end();
      --it;
      forward = false;
    }
    else {

      // Propagation to both ends failed.  Return failure.

      return false;
    }
  }

  // Loop over track fits in global track.
  
  KETrack tre(tremom);
  bool done = false;
  while(!done) {
    KHitTrack& trh = it->second;
    if (trh.getStat() == KFitTrack::INVALID)
      throw cet::exception("KalmanFilterAlg") << "KalmanFilterAlg::updateMomentum(): invalid track\n";

    // Propagate momentum-estimating track to current track surface
    // and update momentum.

    boost::optional<double> dist = prop->noise_prop(tre, trh.getSurface(),
                                                    Propagator::UNKNOWN, true);

    // Copy momentum to global track.

    std::multimap<double, KHitTrack>::iterator erase_it = trackmap.end();
    if(!!dist) {
      trh.getVector()(4) = tre.getVector()(4);
      trh.getError()(4,0) = 0.;
      trh.getError()(4,1) = 0.;
      trh.getError()(4,2) = 0.;
      trh.getError()(4,3) = 0.;
      trh.getError()(4,4) = tre.getError()(4,4);
    }
    else {

      // If the propagation failed, remember that we are supposed to
      // erase this track from the global track.

      erase_it = it;
    }

    // Advance the iterator and set the done flag.

    if(forward) {
      ++it;
      done = (it == trackmap.end());
    }
    else {
      done = (it == trackmap.begin());
      if(!done)
        --it;
    }

    // Update momentum-estimating track from just-updated global track
    // fit, or erase global track fit.

    if(erase_it == trackmap.end())
      tre = trh;
    else
      trackmap.erase(erase_it);
  }

  bool result = (trackmap.size() > 0);

  // Print value of momentum at start of track.

  //if(result) {
  //  mf::LogInfo log("KalmanFilterAlg");
  //  double invp = trg.startTrack().getVector()(4);
  //  double var_invp = trg.startTrack().getError()(4,4);
  //  double p = 0.;
  //  if(invp != 0.)
  //    p = 1./invp;
  //  double err_p = p*p * std::sqrt(var_invp);
  //  log << "Updated momentum estimate = " << p << "+-" << err_p;
  //}

  return result;
}

Member Data Documentation

std::vector<std::unique_ptr<TCanvas> > trkf::KalmanFilterAlg::fCanvases

mutableprivate

Graphical trace canvases.

Definition at line 162 of file KalmanFilterAlg.h.

Referenced by buildTrack(), cleanTrack(), extendTrack(), and smoothTrack().

bool trkf::KalmanFilterAlg::fFitMomMS

private

Fit momentum using multiple scattering.

Definition at line 150 of file KalmanFilterAlg.h.

Referenced by fitMomentum(), and reconfigure().

bool trkf::KalmanFilterAlg::fFitMomRange

private

Fit momentum using range.

Definition at line 149 of file KalmanFilterAlg.h.

Referenced by fitMomentum(), and reconfigure().

double trkf::KalmanFilterAlg::fGapDist

private

Minimum gap distance.

Definition at line 146 of file KalmanFilterAlg.h.

Referenced by cleanTrack(), and reconfigure().

double trkf::KalmanFilterAlg::fGoodPErr

private

Pointing error threshold for switching to free propagation.

Definition at line 133 of file KalmanFilterAlg.h.

Referenced by buildTrack(), and reconfigure().

bool trkf::KalmanFilterAlg::fGTrace

private

Graphical trace flag.

Definition at line 151 of file KalmanFilterAlg.h.

Referenced by buildTrack(), cleanTrack(), extendTrack(), reconfigure(), and smoothTrack().

double trkf::KalmanFilterAlg::fGTraceWH

private

Window height.

Definition at line 153 of file KalmanFilterAlg.h.

Referenced by buildTrack(), and reconfigure().

double trkf::KalmanFilterAlg::fGTraceWW

private

Window width.

Definition at line 152 of file KalmanFilterAlg.h.

Referenced by buildTrack(), and reconfigure().

double trkf::KalmanFilterAlg::fGTraceXMax

private

Graphical trace maximum x.

Definition at line 155 of file KalmanFilterAlg.h.

Referenced by buildTrack(), and reconfigure().

double trkf::KalmanFilterAlg::fGTraceXMin

private

Graphical trace minimum x.

Definition at line 154 of file KalmanFilterAlg.h.

Referenced by buildTrack(), and reconfigure().

std::vector<double> trkf::KalmanFilterAlg::fGTraceZMax

private

Graphical trace maximum z for each view.

Definition at line 157 of file KalmanFilterAlg.h.

Referenced by buildTrack(), and reconfigure().

std::vector<double> trkf::KalmanFilterAlg::fGTraceZMin

private

Graphical trace minimum z for each view.

Definition at line 156 of file KalmanFilterAlg.h.

Referenced by buildTrack(), and reconfigure().

TVirtualPad* trkf::KalmanFilterAlg::fInfoPad

mutableprivate

Information pad.

Definition at line 164 of file KalmanFilterAlg.h.

Referenced by buildTrack(), and extendTrack().

std::map<int, TMarker*> trkf::KalmanFilterAlg::fMarkerMap

mutableprivate

Markers in current canvas.

Definition at line 166 of file KalmanFilterAlg.h.

Referenced by buildTrack(), cleanTrack(), extendTrack(), and smoothTrack().

double trkf::KalmanFilterAlg::fMaxEndChisq

private

Maximum incremental chisquare for endpoint hit.

Definition at line 137 of file KalmanFilterAlg.h.

Referenced by cleanTrack(), and reconfigure().

double trkf::KalmanFilterAlg::fMaxIncChisq

private

Maximum incremental chisquare to accept a hit.

Definition at line 134 of file KalmanFilterAlg.h.

Referenced by extendTrack(), and reconfigure().

double trkf::KalmanFilterAlg::fMaxLDist

private

Maximum distance for linearized propagation.

Definition at line 139 of file KalmanFilterAlg.h.

Referenced by buildTrack(), and reconfigure().

int trkf::KalmanFilterAlg::fMaxNoiseHits

private

Maximum number of hits in noise cluster.

Definition at line 147 of file KalmanFilterAlg.h.

Referenced by cleanTrack(), and reconfigure().

double trkf::KalmanFilterAlg::fMaxPErr

private

Maximum pointing error for free propagation.

Definition at line 132 of file KalmanFilterAlg.h.

Referenced by buildTrack(), extendTrack(), and reconfigure().

double trkf::KalmanFilterAlg::fMaxPredDist

private

Maximum prediciton distance to accept a hit.

Definition at line 140 of file KalmanFilterAlg.h.

Referenced by extendTrack(), and reconfigure().

double trkf::KalmanFilterAlg::fMaxPropDist

private

Maximum propagation distance to candidate surface.

Definition at line 142 of file KalmanFilterAlg.h.

Referenced by buildTrack(), extendTrack(), and reconfigure().

int trkf::KalmanFilterAlg::fMaxSamePlane

private

Maximum consecutive hits in same plane.

Definition at line 145 of file KalmanFilterAlg.h.

Referenced by buildTrack(), extendTrack(), and reconfigure().

double trkf::KalmanFilterAlg::fMaxSeedIncChisq

private

Maximum incremental chisquare to accept a hit in seed phase.

Definition at line 135 of file KalmanFilterAlg.h.

Referenced by buildTrack(), and reconfigure().

double trkf::KalmanFilterAlg::fMaxSeedPredDist

private

Maximum prediciton distance to accept a hit in seed phase.

Definition at line 141 of file KalmanFilterAlg.h.

Referenced by buildTrack(), and reconfigure().

double trkf::KalmanFilterAlg::fMaxSmoothIncChisq

private

Maximum incremental chisquare to accept a hit in smooth phase.

Definition at line 136 of file KalmanFilterAlg.h.

Referenced by reconfigure(), and smoothTrack().

double trkf::KalmanFilterAlg::fMaxSortDist

private

Sort high distance threshold.

Definition at line 144 of file KalmanFilterAlg.h.

Referenced by buildTrack(), extendTrack(), and reconfigure().

TPaveText* trkf::KalmanFilterAlg::fMessages

mutableprivate

Message box.

Definition at line 165 of file KalmanFilterAlg.h.

Referenced by buildTrack(), and extendTrack().

int trkf::KalmanFilterAlg::fMinLHits

private

Minimum number of hits to turn off linearized propagation.

Definition at line 138 of file KalmanFilterAlg.h.

Referenced by buildTrack(), and reconfigure().

double trkf::KalmanFilterAlg::fMinSampleDist

private

Minimum sample distance (for momentum measurement).

Definition at line 148 of file KalmanFilterAlg.h.

Referenced by fitMomentumMS(), and reconfigure().

double trkf::KalmanFilterAlg::fMinSortDist

private

Sort low distance threshold.

Definition at line 143 of file KalmanFilterAlg.h.

Referenced by reconfigure().

std::vector<TVirtualPad*> trkf::KalmanFilterAlg::fPads

mutableprivate

View pads in current canvas.

Definition at line 163 of file KalmanFilterAlg.h.

Referenced by buildTrack(), and extendTrack().

int trkf::KalmanFilterAlg::fPlane

private

Preferred view plane.

Definition at line 161 of file KalmanFilterAlg.h.

Referenced by buildTrack(), extendTrack(), getPlane(), and setPlane().

bool trkf::KalmanFilterAlg::fTrace

private

Trace flag.

Definition at line 131 of file KalmanFilterAlg.h.

Referenced by buildTrack(), extendTrack(), getTrace(), reconfigure(), setTrace(), and smoothTrack().

---

The documentation for this class was generated from the following files:

• /cvmfs/larsoft.opensciencegrid.org/products/larreco/v07_10_02/source/larreco/RecoAlg/KalmanFilterAlg.h
• /cvmfs/larsoft.opensciencegrid.org/products/larreco/v07_10_02/source/larreco/RecoAlg/KalmanFilterAlg.cxx