#include <TrkDifPieceTraj.h>

Inheritance diagram for TrkDifPieceTraj:

Public Member Functions
	TrkDifPieceTraj (const TrkSimpTraj &, const double lowlim, const double hilim)

	TrkDifPieceTraj (TrkSimpTraj *, const double lowlim, const double hilim)

	TrkDifPieceTraj (const TrkDifPieceTraj &)

	TrkDifPieceTraj (const std::vector< TrkSimpTraj * > &trajs)

virtual	~TrkDifPieceTraj ()

TrkDifPieceTraj &	operator= (const TrkDifPieceTraj &)

bool	operator== (const TrkDifPieceTraj &other) const

TrkDifPieceTraj &	invert ()

TrkDifPieceTraj *	clone () const

void	getDFInfo (double fltLen, DifPoint &pos, DifVector &direction, DifVector &delDirect) const

void	getDFInfo2 (double fltlen, DifPoint &pos, DifVector &direction) const

HepPoint3D	position (double) const

Hep3Vector	direction (double) const

double	curvature (double f=0.) const

Hep3Vector	delDirect (double) const

void	getInfo (double fltLen, HepPoint3D &, Hep3Vector &direction) const

void	getInfo (double fltLen, HepPoint3D &, Hep3Vector &direction, Hep3Vector &delDirect) const

double	distTo1stError (double s, double tol, int pathDir) const

double	distTo2ndError (double s, double tol, int pathDir) const

const TrkSimpTraj *	localTrajectory (double, double &) const

bool	locallyValid (double glen, double tol=0.0) const

void	setFlightRange (double newrange[2])

void	print (std::ostream &os) const

void	printAll (std::ostream &os) const

const TrkErrCode &	append (double gfltlen, const TrkSimpTraj &, double &gap)

const TrkErrCode &	prepend (double gfltlen, const TrkSimpTraj &, double &gap)

const TrkErrCode &	append (double gfltlen, TrkSimpTraj *, double &gap)

const TrkErrCode &	prepend (double gfltlen, TrkSimpTraj *, double &gap)

const TrkErrCode &	append (double, const TrkDifPieceTraj &, double &gap)

const TrkErrCode &	prepend (double, const TrkDifPieceTraj &, double &gap)

const TrkErrCode &	append (TrkSimpTraj *traj, double &gap)

const TrkErrCode &	prepend (TrkSimpTraj *traj, double &gap)

HepMatrix	derivDeflect (double fltlen, deflectDirection) const

HepMatrix	derivDisplace (double fltlen, deflectDirection idir) const

HepMatrix	derivPFract (double fltlen) const

Public Member Functions inherited from TrkDifTraj
	TrkDifTraj (const double lowlim=-99999., const double hilim=99999.)

virtual	~TrkDifTraj ()

Public Member Functions inherited from Trajectory
	Trajectory (double lowlim, double hilim)

virtual	~Trajectory ()

double	distTo0thError (double s, double tol, int pathDir) const

bool	validFlightDistance (double f, double tolerance=0.0) const

double	lowRange () const

double	hiRange () const

double	range () const

Public Member Functions inherited from TrkKalDeriv

Protected Member Functions
int	resize (double len, trkDirection)

int	trajIndex (const double &global, double &local) const

double	localDist (int index, double globdist) const

double	globalDist (int index, double locdist) const

Protected Member Functions inherited from Trajectory
Trajectory &	operator= (const Trajectory &)

Protected Attributes
std::deque< TrkSimpTraj * >	_localtraj

std::deque< double >	_globalrange

int	_lastIndex

Protected Attributes inherited from Trajectory
double	flightrange [2]

Detailed Description

Definition at line 28 of file TrkDifPieceTraj.h.

Constructor & Destructor Documentation

◆ TrkDifPieceTraj() [1/4]

TrkDifPieceTraj::TrkDifPieceTraj	(	const TrkSimpTraj &	seed,
		const double	lowlim,
		const double	hilim )

Definition at line 30 of file TrkDifPieceTraj.cxx.

                                                                                               :
  TrkDifTraj(lowlim,hilim), _lastIndex(-1)
{
  // _localtraj.reserve(16); _globalrange.reserve(16);
  _localtraj.push_back((TrkSimpTraj*)seed.clone());
  assert(lowlim < hilim);
  _globalrange.push_back(lowlim);
  _globalrange.push_back(hilim);
// don't assume the local trajectory has the same range, but do respect it's starting point
  double locrange[2];
  locrange[0] = seed.lowRange();
  locrange[1] = hilim-lowlim+locrange[0];
  _localtraj.front()->setFlightRange(locrange);
}

Referenced by clone().

◆ TrkDifPieceTraj() [2/4]

TrkDifPieceTraj::TrkDifPieceTraj	(	TrkSimpTraj *	seed,
		const double	lowlim,
		const double	hilim )

Definition at line 45 of file TrkDifPieceTraj.cxx.

                                                                                         :
  TrkDifTraj(lowlim,hilim), _lastIndex(-1)
{
  // _localtraj.reserve(16); _globalrange.reserve(16);
  assert(lowlim < hilim);
  _globalrange.push_back(lowlim);
  _globalrange.push_back(hilim);
// don't assume the local trajectory has the same range, but do respect it's starting point
  double locrange[2];
  locrange[0] = seed->lowRange();
  locrange[1] = hilim-lowlim+locrange[0];
  seed->setFlightRange(locrange);
  _localtraj.push_back(seed);
}

◆ TrkDifPieceTraj() [3/4]

TrkDifPieceTraj::TrkDifPieceTraj ( const TrkDifPieceTraj & other )

Definition at line 61 of file TrkDifPieceTraj.cxx.

                                                             :
  TrkDifTraj(other.lowRange(),other.hiRange()),
  _globalrange(other._globalrange),
  _lastIndex(other._lastIndex)
{
//
// deep-copy all the trajectory pieces
//
  // _localtraj.reserve(other._localtraj.size());
  typedef std::deque<TrkSimpTraj *>::const_iterator iter_t;
  iter_t end = other._localtraj.end();
  for(iter_t i=other._localtraj.begin();i!=end; ++i)
    _localtraj.push_back( (TrkSimpTraj*) (*i)->clone());
}

◆ TrkDifPieceTraj() [4/4]

TrkDifPieceTraj::TrkDifPieceTraj ( const std::vector< TrkSimpTraj * > & trajs )

Definition at line 76 of file TrkDifPieceTraj.cxx.

{
  // _localtraj.reserve(trajs.size());_globalrange.reserve(trajs.size()+1);
// intialize
  TrkSimpTraj* prevtraj(0);
  for(std::vector<TrkSimpTraj*>::const_iterator itraj=trajs.begin();itraj!=trajs.end();++itraj){
    TrkSimpTraj* newtraj = (*itraj)->clone();
    assert(newtraj != 0);
    if(prevtraj != 0){
// Hopefully the trajs are in order
      TrkErrCode add;
      double gap;
      if(newtraj->lowRange() > prevtraj->lowRange())
        add = append(newtraj,gap);
      else
        add = prepend(newtraj,gap);
      if(add.failure()){
#ifdef MDCPATREC_WARNING
        std::cout<<"ErrMsg(warning) "
        << "construction from vector of trajs failed"
        << add << std::endl;
#endif
        delete newtraj;
        break;
      }
    } else {
// Initial global flightlength is defined by the first trajectory
      _localtraj.push_back(newtraj);
      _globalrange.push_back(newtraj->lowRange());
      _globalrange.push_back(newtraj->hiRange());
// set the global range
      flightrange[0] = _globalrange.front();
      flightrange[1] = _globalrange.back();
    }
    prevtraj = _localtraj[itraj-trajs.begin()];
  }
}

◆ ~TrkDifPieceTraj()

TrkDifPieceTraj::~TrkDifPieceTraj ( )

virtual

Definition at line 114 of file TrkDifPieceTraj.cxx.

{
  std::for_each(_localtraj.begin(),
                _localtraj.end(),
                bes::Collection::DeleteObject());
}

Member Function Documentation

◆ append() [1/4]

const TrkErrCode & TrkDifPieceTraj::append	(	double	gfltlen,
		const TrkSimpTraj &	nexttraj,
		double &	gap )

Definition at line 259 of file TrkDifPieceTraj.cxx.

{
  return append(glen,nexttraj.clone(),gap);
}

Referenced by append(), append(), and TrkDifPieceTraj().

◆ append() [2/4]

const TrkErrCode & TrkDifPieceTraj::append	(	double	gfltlen,
		TrkSimpTraj *	nexttraj,
		double &	gap )

Definition at line 167 of file TrkDifPieceTraj.cxx.

{
  static TrkErrCode retval;
  retval = TrkErrCode(TrkErrCode::succeed);
// simple range checks
  if(glen >= lowRange()){
// resize the end if necessary
    int nremoved = resize(glen,trkOut);
    if(nremoved > 0) {
#ifdef MDCPATREC_WARNING
      std::cout<<"ErrMsg(warning)" << "append removed "
          << nremoved << " old trajectories" << std::endl;
#endif
    }
//  Compute POCA for this trajectory to the point at the end of the existing trajectory
    HepPoint3D endpoint = position(glen);
    HepPoint3D newend = nexttraj->position(nexttraj->lowRange());
    gap = newend.distance(endpoint);
    double range[2];
    range[0] = nexttraj->lowRange();
    range[1] = nexttraj->hiRange();
    double delta = max(hiRange() - glen,range[1]-range[0]);
    if(gap > _TOL){ // Don't invoke POCA if the point is too close
      TrkPoca endpoca(*nexttraj,nexttraj->lowRange(),endpoint,_TOL);
      if(endpoca.status().failure()){
        retval = TrkErrCode(TrkErrCode::fail,7,"poca failure");
        return retval;
      }
      range[0] = endpoca.flt1();
      gap = endpoca.doca();
    }
// make sure the global range stays at least as long as before
    range[1] = range[0] + delta;
// resize it
    nexttraj->setFlightRange(range);
// append the trajectory
    _localtraj.push_back(nexttraj);
// append the new global range
    _globalrange.push_back(glen+delta);
    flightrange[1] = glen+delta;
  } else
    retval = TrkErrCode(TrkErrCode::fail,6," cannot append before minimum flight range");
  return retval;
}

◆ append() [3/4]

const TrkErrCode & TrkDifPieceTraj::append	(	double	glen,
		const TrkDifPieceTraj &	other,
		double &	gap )

Definition at line 272 of file TrkDifPieceTraj.cxx.

{
  static TrkErrCode retval;
  retval = TrkErrCode(TrkErrCode::succeed);
// find POCA between the trajectories.
  double mylen = glen;
  HepPoint3D myend = position(mylen);
  double otherlen = other.lowRange();
  HepPoint3D otherstart = other.position(otherlen);
  gap = otherstart.distance(myend);
  if(gap > _TOL){ // Don't invoke POCA if the point is too close
    TrkPoca endpoca(other,other.lowRange(),myend,_TOL);
    if(endpoca.status().failure()){
      retval = TrkErrCode(TrkErrCode::fail,7,"poca failure");
      return retval;
    }
    gap = endpoca.doca();
    otherlen = endpoca.flt1();
  }
// get the local trajectory piece at this fltlen
  double loclen(0);
  double piecegap;
// loop over segments in the other trajectory
  for(int itraj = other.trajIndex(otherlen,loclen);
      itraj < other._localtraj.size();itraj++){
// append the piece from the other trajectory
    retval = append(mylen,*(other._localtraj[itraj]),piecegap);
    if(retval.failure())
      break;
// move forward
    mylen = hiRange();
  }
  return retval;
}

◆ append() [4/4]

const TrkErrCode & TrkDifPieceTraj::append	(	TrkSimpTraj *	traj,
		double &	gap )

Definition at line 711 of file TrkDifPieceTraj.cxx.

{
  static TrkErrCode retval;
  retval = TrkErrCode(TrkErrCode::succeed);
// find out where this piece is relative to the existing pieces.
  HepPoint3D end = newtraj->position(newtraj->lowRange());
  TrkPoca poca(*this,newtraj->lowRange(),end,_TOL);
  if(poca.status().success()){
// find the local trajectory pieces at either end
    double local;
    int index = trajIndex(poca.flt1(),local);
    TrkSimpTraj* oldtraj = _localtraj[index];
// Make sure we're beyond the end of the existing trajectory
    if( index == _localtraj.size()-1 &&
        poca.flt1() > hiRange()){
// we want to split the gap between the traj pieces evenly,
      double gapstart = globalDist(index,oldtraj->hiRange());
      double gapend = poca.flt1();
      double gapmid = (gapend+gapstart)/2.0;
      HepPoint3D mid = position(gapmid);
// approximate initial (local) fltlen for poca
      double locmid = newtraj->lowRange() - gapend + gapmid;
      TrkPoca midpoca(*newtraj,locmid,mid,_TOL);
      if(midpoca.status().success()){
// create a 0-length copy of the new traj to associate with the midpoint.
// This insures correct coverage of the global flight range
        TrkSimpTraj* gaptraj = (TrkSimpTraj*)(newtraj->clone());
        assert(gaptraj != 0);
        double range[2];
        range[0] = midpoca.flt1();
        range[1] = range[0];
        gaptraj->setFlightRange(range);
// insert the trajectories
        _localtraj.push_back(gaptraj);
        _localtraj.push_back(newtraj);
// append the new global range
        _globalrange.back() = gapmid;
        _globalrange.push_back(gapend);
        _globalrange.push_back(gapend+newtraj->range());
// extend the piece-trajs own range
        flightrange[1] = _globalrange.back();
// measure the gap at the midpoint
        gap = mid.distance(newtraj->position(midpoca.flt1()));
      } else
        retval = TrkErrCode(TrkErrCode::fail,7,"poca failure");
    } else
      retval = TrkErrCode(TrkErrCode::fail,8,"invalid range");
  } else
    retval = TrkErrCode(TrkErrCode::fail,7,"poca failure");
  return retval;
}

◆ clone()

TrkDifPieceTraj * TrkDifPieceTraj::clone ( ) const

inlinevirtual

Implements Trajectory.

Definition at line 48 of file TrkDifPieceTraj.h.

48{return new TrkDifPieceTraj(*this); }

TrkDifPieceTraj::TrkDifPieceTraj

TrkDifPieceTraj(const TrkSimpTraj &, const double lowlim, const double hilim)

Definition TrkDifPieceTraj.cxx:30

◆ curvature()

double TrkDifPieceTraj::curvature ( double f = 0. ) const

virtual

Implements Trajectory.

Definition at line 437 of file TrkDifPieceTraj.cxx.

{
//
//  First, find the right trajectory piece, then give the local curvature
//
  double localflight(0.0);
  const TrkSimpTraj* loctraj = localTrajectory(flightdist,localflight);
  return loctraj->curvature(localflight);
}

◆ delDirect()

Hep3Vector TrkDifPieceTraj::delDirect ( double flightdist ) const

virtual

Implements Trajectory.

Definition at line 448 of file TrkDifPieceTraj.cxx.

{
//
//  First, find the right trajectory piece, then give the local value
//
  double localflight(0.0);
  const TrkSimpTraj* loctraj = localTrajectory(flightdist,localflight);
  return loctraj->delDirect(localflight);
}

Referenced by getDFInfo().

◆ derivDeflect()

HepMatrix TrkDifPieceTraj::derivDeflect	(	double	fltlen,
		deflectDirection	idir ) const

virtual

Implements TrkKalDeriv.

Definition at line 687 of file TrkDifPieceTraj.cxx.

{
  double localflight(0.0);
  const TrkSimpTraj* loctraj = localTrajectory(flightdist,localflight);
  return loctraj->derivDeflect(localflight,idir);
}

◆ derivDisplace()

HepMatrix TrkDifPieceTraj::derivDisplace	(	double	fltlen,
		deflectDirection	idir ) const

virtual

Implements TrkKalDeriv.

Definition at line 695 of file TrkDifPieceTraj.cxx.

{
  double localflight(0.0);
  const TrkSimpTraj* loctraj = localTrajectory(flightdist,localflight);
  return loctraj->derivDisplace(localflight,idir);
}

◆ derivPFract()

HepMatrix TrkDifPieceTraj::derivPFract ( double fltlen ) const

virtual

Implements TrkKalDeriv.

Definition at line 703 of file TrkDifPieceTraj.cxx.

{
  double localflight(0.0);
  const TrkSimpTraj* loctraj = localTrajectory(flightdist,localflight);
  return loctraj->derivPFract(localflight);
}

◆ direction()

Hep3Vector TrkDifPieceTraj::direction ( double flightdist ) const

virtual

Implements Trajectory.

Definition at line 426 of file TrkDifPieceTraj.cxx.

{
//
//  First, find the right trajectory piece, then give the local direction
//
  double localflight(0.0);
  const TrkSimpTraj* loctraj = localTrajectory(flightdist,localflight);
  return loctraj->direction(localflight);
}

Referenced by getDFInfo(), and getDFInfo2().

◆ distTo1stError()

double TrkDifPieceTraj::distTo1stError	(	double	s,
		double	tol,
		int	pathDir ) const

virtual

Implements Trajectory.

Definition at line 486 of file TrkDifPieceTraj.cxx.

{
//
//  First, find the right trajectory piece
//
  double localflight(0.0);
  int index = trajIndex(flightdist,localflight);
  const TrkSimpTraj* loctraj = _localtraj[index];
//
//  Ask the local piece for it's dist, and take the minimum of this or the
//  distance to the next trajectory piece
//
  double localdist = loctraj->distTo1stError(localflight,tol,dir);
//
//  Take the minimum of this distance and the distance to the next trajectory
  double dist = localdist;
  if (dir > 0){
    if(index < _localtraj.size()-1)
      dist = min(localdist,_globalrange[index+1]-flightdist) + STEPEPSILON;
  } else {
    if(index > 0)
      dist = min(localdist,flightdist - _globalrange[index]) + STEPEPSILON;
  }
  return dist;
}

◆ distTo2ndError()

double TrkDifPieceTraj::distTo2ndError	(	double	s,
		double	tol,
		int	pathDir ) const

virtual

Implements Trajectory.

Definition at line 513 of file TrkDifPieceTraj.cxx.

{
//
//  First, find the right trajectory piece
//
  double localflight(0.0);
  int index = trajIndex(flightdist,localflight);
  const TrkSimpTraj* loctraj = _localtraj[index];
//
//  Ask the local piece for it's dist, and take the minimum of this or the
//  distance to the next trajectory piece
//
  double localdist = loctraj->distTo2ndError(localflight,tol,dir);
//
//  Take the minimum of this distance and the distance to the next trajectory
  double dist = localdist;
  if (dir > 0){
    if(index < _localtraj.size()-1)
      dist = min(localdist,_globalrange[index+1]-flightdist) + STEPEPSILON;
  } else {
    if(index > 0)
      dist = min(localdist,flightdist - _globalrange[index]) + STEPEPSILON;
  }
  return dist;
}

◆ getDFInfo()

void TrkDifPieceTraj::getDFInfo	(	double	fltLen,
		DifPoint &	pos,
		DifVector &	direction,
		DifVector &	delDirect ) const

virtual

Implements TrkDifTraj.

Definition at line 122 of file TrkDifPieceTraj.cxx.

{
//
//  First, find the right trajectory piece, then give the local position
//
  double localflight(0.0);
  const TrkSimpTraj* loctraj = localTrajectory(flightdist,localflight);
  loctraj->getDFInfo(localflight,pos,direction,delDirect);
}

◆ getDFInfo2()

void TrkDifPieceTraj::getDFInfo2	(	double	fltlen,
		DifPoint &	pos,
		DifVector &	direction ) const

virtual

Reimplemented from TrkDifTraj.

Definition at line 134 of file TrkDifPieceTraj.cxx.

{
//
//  First, find the right trajectory piece, then give the local position
//
  double localflight(0.0);
  const TrkSimpTraj* loctraj = localTrajectory(flightdist,localflight);
  loctraj->getDFInfo2(localflight,pos,direction);
}

◆ getInfo() [1/2]

void TrkDifPieceTraj::getInfo	(	double	fltLen,
		HepPoint3D &	point,
		Hep3Vector &	direction ) const

virtual

Implements Trajectory.

Definition at line 459 of file TrkDifPieceTraj.cxx.

{
//
//  First, find the right trajectory piece, then call the local function
//
  double localflight(0.0);
  const TrkSimpTraj* loctraj = localTrajectory(flightdist,localflight);
  loctraj->getInfo(localflight,point,dir);
}

◆ getInfo() [2/2]

void TrkDifPieceTraj::getInfo	(	double	fltLen,
		HepPoint3D &	point,
		Hep3Vector &	direction,
		Hep3Vector &	delDirect ) const

virtual

Implements Trajectory.

Definition at line 472 of file TrkDifPieceTraj.cxx.

{
//
//  First, find the right trajectory piece, then call the local function
//
  double localflight(0.0);
  const TrkSimpTraj* loctraj = localTrajectory(flightdist,localflight);
  loctraj->getInfo(localflight,point,dir,deldirect);
}

◆ globalDist()

double TrkDifPieceTraj::globalDist	(	int	index,
		double	locdist ) const

inlineprotected

Definition at line 132 of file TrkDifPieceTraj.h.

                                                    {
    return _globalrange[index] + locdist -  _localtraj[index]->lowRange();
  }

Referenced by append(), and prepend().

◆ invert()

TrkDifPieceTraj & TrkDifPieceTraj::invert ( )

Definition at line 345 of file TrkDifPieceTraj.cxx.

{
// make local copies & clear data members
  std::deque<TrkSimpTraj*> trajcopy; trajcopy.swap(_localtraj);
  std::deque<double> rangecopy;      rangecopy.swap(_globalrange);
  assert(_localtraj.size()==0);
  assert(_globalrange.size()==0);
// global range starts at the end of the old range
  _globalrange.push_back(-rangecopy.back());
// loop over the trajectory pieces in backwards order
  for(int itraj=trajcopy.size()-1;itraj>=0;itraj--){
// invert the simptraj and re-append it
    _localtraj.push_back(&(trajcopy[itraj]->invert()));
// set the global range
    _globalrange.push_back(-rangecopy[itraj]);
  }
// reset this traj's range
  double range[2];
  range[0] = -hiRange();
  range[1] = -lowRange();
  Trajectory::setFlightRange(range);
  return *this;
}

Referenced by invert().

◆ localDist()

double TrkDifPieceTraj::localDist	(	int	index,
		double	globdist ) const

inlineprotected

Definition at line 128 of file TrkDifPieceTraj.h.

                                                    {
    return _localtraj[index]->lowRange() + globdist - _globalrange[index];
  }

Referenced by setFlightRange(), and trajIndex().

◆ locallyValid()

bool TrkDifPieceTraj::locallyValid	(	double	glen,
		double	tol = 0.0 ) const

Definition at line 816 of file TrkDifPieceTraj.cxx.

{
  double localflight(0.0);
  const TrkSimpTraj* loctraj = localTrajectory(glen,localflight);
  return loctraj != 0 &&
    localflight-tol <= loctraj->hiRange()  &
    localflight+tol >= loctraj->lowRange();
}

◆ localTrajectory()

const TrkSimpTraj * TrkDifPieceTraj::localTrajectory	(	double	flightdist,
		double &	localflight ) const

virtual

Implements TrkDifTraj.

Definition at line 541 of file TrkDifPieceTraj.cxx.

{
//
//  Find and return the right trajectory piece
//
  int index = trajIndex(flightdist,localflight);
  return _localtraj[index];
}

Referenced by curvature(), delDirect(), derivDeflect(), derivDisplace(), derivPFract(), direction(), getDFInfo(), getDFInfo2(), getInfo(), getInfo(), locallyValid(), and position().

◆ operator=()

TrkDifPieceTraj & TrkDifPieceTraj::operator= ( const TrkDifPieceTraj & other )

Definition at line 146 of file TrkDifPieceTraj.cxx.

{
  if (&other == this) return *this;
  flightrange[0] = other.flightrange[0];
  flightrange[1] = other.flightrange[1];
  _globalrange = other._globalrange;
//
// deep-copy all the trajectory pieces
//
  std::for_each(_localtraj.begin(),_localtraj.end(),bes::Collection::DeleteObject());
  _localtraj.clear(); // _localtraj.reserve(other._localtraj.size());
  typedef std::deque<TrkSimpTraj*>::const_iterator iter_t;
  for(iter_t i=other._localtraj.begin();i!=other._localtraj.end();++i)
    _localtraj.push_back((*i)->clone());
  return *this;
}

◆ operator==()

bool TrkDifPieceTraj::operator== ( const TrkDifPieceTraj & other ) const

Definition at line 826 of file TrkDifPieceTraj.cxx.

                                                                {
  bool retval(true);
  if(retval) retval = _globalrange == other._globalrange;
  if(retval) retval = _localtraj.size() == other._localtraj.size();
// loop over component trajs
  std::deque<TrkSimpTraj*>::const_iterator miter = _localtraj.begin();
  std::deque<TrkSimpTraj*>::const_iterator oiter = other._localtraj.begin();
  while(retval && miter != _localtraj.end() && oiter != other._localtraj.end()){
    retval = (*oiter)->parameters()->parameter() == (*miter)->parameters()->parameter() &&
      (*oiter)->parameters()->covariance() == (*miter)->parameters()->covariance();
    miter++;oiter++;
  }
  return retval;
}

◆ position()

HepPoint3D TrkDifPieceTraj::position ( double flightdist ) const

virtual

Implements Trajectory.

Definition at line 415 of file TrkDifPieceTraj.cxx.

{
//
//  First, find the right trajectory piece, then give the local position
//
  double localflight(0.0);
  const TrkSimpTraj* loctraj = localTrajectory(flightdist,localflight);
  return loctraj->position(localflight);
}

Referenced by append(), append(), append(), prepend(), prepend(), and prepend().

◆ prepend() [1/4]

const TrkErrCode & TrkDifPieceTraj::prepend	(	double	gfltlen,
		const TrkSimpTraj &	nexttraj,
		double &	gap )

Definition at line 265 of file TrkDifPieceTraj.cxx.

{
  return prepend(glen,nexttraj.clone(),gap);
}

Referenced by prepend(), prepend(), and TrkDifPieceTraj().

◆ prepend() [2/4]

const TrkErrCode & TrkDifPieceTraj::prepend	(	double	gfltlen,
		TrkSimpTraj *	nexttraj,
		double &	gap )

Definition at line 213 of file TrkDifPieceTraj.cxx.

{
  static TrkErrCode retval;
  retval = TrkErrCode(TrkErrCode::succeed);
// simple range checks
  if(glen <= hiRange()){
// resize
    int nremoved = resize(glen,trkIn);
    if(nremoved > 0) {
#ifdef MDCPATREC_WARNING
      std::cout<<"ErrMsg(warning) "<<  " prepend removed "
          << nremoved << " old trajectories" << std::endl;
#endif
    }
//  Compute POCA for this trajectory to the point at the end of the existing trajectory
    HepPoint3D endpoint = position(glen);
    HepPoint3D newend = nexttraj->position(nexttraj->hiRange());
    gap = newend.distance(endpoint);
    double range[2];
    range[0] = nexttraj->lowRange();
    range[1] = nexttraj->hiRange();
    double delta = max(glen -lowRange(),range[1]-range[0]);
    if(gap > _TOL){ // Don't invoke POCA if the point is too close
      TrkPoca endpoca(*nexttraj,nexttraj->hiRange(),endpoint,_TOL);
      if(endpoca.status().failure()){
        retval = TrkErrCode(TrkErrCode::fail,7,"poca failure");
        return retval;
      }
      range[1] = endpoca.flt1();
      gap = endpoca.doca();
    }
// make sure the global range stays at least as long as before
    range[0] = range[1] - delta;
// resize it
    nexttraj->setFlightRange(range);
// prepend the trajectory
    _localtraj.push_front(nexttraj);
// prepend the new global range
    _globalrange.push_front(glen-delta);
    flightrange[0] = glen-delta;
  } else
    retval = TrkErrCode(TrkErrCode::fail,6," cannot prepend after maximum flight range");
  return retval;
}

◆ prepend() [3/4]

const TrkErrCode & TrkDifPieceTraj::prepend	(	double	glen,
		const TrkDifPieceTraj &	other,
		double &	gap )

Definition at line 308 of file TrkDifPieceTraj.cxx.

{
  static TrkErrCode retval;
  retval = TrkErrCode(TrkErrCode::succeed);
// find POCA between the trajectories.
  double mylen = glen;
  HepPoint3D mystart = position(mylen);
  double otherlen = other.hiRange();
  HepPoint3D otherend = other.position(otherlen);
  gap = otherend.distance(mystart);
  if(gap > _TOL){ // Don't invoke POCA if the point is too close
    TrkPoca endpoca(other,other.hiRange(),mystart,_TOL);
    if(endpoca.status().failure()){
      retval = TrkErrCode(TrkErrCode::fail,7,"poca failure");
      return retval;
    }
    gap = endpoca.doca();
    otherlen = endpoca.flt1();
  }
// get the local trajectory piece at this fltlen
  double loclen(0);
  double piecegap;
// loop over segments in the other trajectory
  for(int itraj = other.trajIndex(otherlen,loclen);
      itraj >= 0;itraj--) {
// prepend the piece from the other trajectory
    retval = prepend(mylen,*(other._localtraj[itraj]),piecegap);
    if(retval.failure())
      break;
// move backwards
    mylen = lowRange();
  }
  return retval;
}

◆ prepend() [4/4]

const TrkErrCode & TrkDifPieceTraj::prepend	(	TrkSimpTraj *	traj,
		double &	gap )

Definition at line 765 of file TrkDifPieceTraj.cxx.

{
  static TrkErrCode retval;
  retval = TrkErrCode(TrkErrCode::succeed);
// find out where this piece is relative to the existing pieces.
  HepPoint3D end = newtraj->position(newtraj->hiRange());
  TrkPoca poca(*this,newtraj->hiRange(),end,_TOL);
  if(poca.status().success()){
// find the local trajectory pieces at either end
    double local;
    int index = trajIndex(poca.flt1(),local);
    TrkSimpTraj* oldtraj = _localtraj[index];
// Make sure we're beyond the end of the existing trajectory
    if( index == 0 && poca.flt1() < lowRange()){
// we want to split the gap between the traj pieces evenly,
      double gapstart = poca.flt1();
      double gapend = globalDist(index,oldtraj->hiRange());
      double gapmid = (gapend+gapstart)/2.0;
      HepPoint3D mid = position(gapmid);
// approximate initial (local) fltlen for poca
      double locmid = newtraj->hiRange() - gapstart + gapmid;
      TrkPoca midpoca(*newtraj,locmid,mid,_TOL);
      if(midpoca.status().success()){
// create a 0-length copy of the new traj to associate with the midpoint.
// This insures correct coverage of the global flight range
        TrkSimpTraj* gaptraj = (TrkSimpTraj*)(newtraj->clone());
        assert(gaptraj != 0);
        double range[2];
        range[0] = midpoca.flt1();
        range[1] = range[0];
        gaptraj->setFlightRange(range);
// insert the trajectories
        _localtraj.push_front(gaptraj);
        _localtraj.push_front(newtraj);
// append the new global range
        _globalrange.push_front(gapmid);
        _globalrange.push_front(gapstart-newtraj->range());
// extend the piece-trajs own range
        flightrange[0] = _globalrange.front();
// measure the gap at the midpoint
        gap = mid.distance(newtraj->position(midpoca.flt1()));
      } else
        retval = TrkErrCode(TrkErrCode::fail,7,"poca failure");
    } else
      retval = TrkErrCode(TrkErrCode::fail,8,"invalid range");
  } else
    retval = TrkErrCode(TrkErrCode::fail,7,"poca failure");
  return retval;
}

◆ print()

void TrkDifPieceTraj::print ( std::ostream & os ) const

virtual

Reimplemented from Trajectory.

Definition at line 603 of file TrkDifPieceTraj.cxx.

{
  os << "TrkDifPieceTraj has " << _localtraj.size() << " pieces "
    << ", total flight range of " << hiRange();
}

◆ printAll()

void TrkDifPieceTraj::printAll ( std::ostream & os ) const

virtual

Reimplemented from Trajectory.

Definition at line 610 of file TrkDifPieceTraj.cxx.

{
  os << "TrkDifPieceTraj has " << _localtraj.size() << " pieces "
    << ", total flight range from "
     << lowRange() << " to " << hiRange() << endl;
  for(int ipiece=0;ipiece<_localtraj.size();ipiece++){
    TrkSimpTraj* tpiece = _localtraj[ipiece];
    double plow = tpiece->lowRange();
    double phi = tpiece->hiRange();
    os << "Piece " << ipiece << " has global range from "
       << _globalrange[ipiece] << " to " << _globalrange[ipiece+1]
       << " and local range from " <<  plow << " to " << phi << endl;
    HepPoint3D start = tpiece->position(plow);
    HepPoint3D end = tpiece->position(phi);
    const HepPoint3D& refp = tpiece->referencePoint();
    os << "Piece " << ipiece << " starts at point "
       << start.x() <<","<< start.y()<<","<< start.z()
       << " and ends at point "
       << end.x()<<"," << end.y()<<"," << end.z()
       << " and references point "
       << refp.x()<<"," << refp.y()<<"," << refp.z()
       << endl;
  }
}

◆ resize()

int TrkDifPieceTraj::resize	(	double	len,
		trkDirection	tdir )

protected

Definition at line 553 of file TrkDifPieceTraj.cxx.

{
  int nremoved(0);
  TrkSimpTraj* trajpiece;
  double oldend,locdist;
  double lrange[2];
  int ipiece = trajIndex(len,locdist);
  switch(tdir) {
  case trkIn:
//
//  Reset the range.  Delete trajectory pieces till we're in range.
//  This will leave the trajectory with a starting range different from
//  0, but it'll still be self-consistent
//
    while(ipiece > 0){
      nremoved++;
      trajpiece = _localtraj.front(); _localtraj.pop_front();
      delete trajpiece;
      oldend = _globalrange.front(); _globalrange.pop_front();
      ipiece = trajIndex(len,locdist);
    }
//  reset the global range
    flightrange[0] = len;
    _globalrange[ipiece] = len;
//  reset the local traj piece range
    lrange[0] = locdist;
    lrange[1] = _localtraj[ipiece]->hiRange();
    _localtraj[ipiece]->setFlightRange(lrange);
    break;
  case trkOut:
    while(ipiece < _localtraj.size() - 1){
      nremoved++;
      trajpiece = _localtraj.back(); _localtraj.pop_back();
      delete trajpiece;
      oldend = _globalrange.back(); _globalrange.pop_back();
      ipiece = trajIndex(len,locdist);
    }
    flightrange[1] = len;
    _globalrange[ipiece+1] = len;
    lrange[0] = _localtraj[ipiece]->lowRange();
    lrange[1] = locdist;
    _localtraj[ipiece]->setFlightRange(lrange);
    break;
  }
  return nremoved;
}

Referenced by append(), prepend(), and setFlightRange().

◆ setFlightRange()

void TrkDifPieceTraj::setFlightRange ( double newrange[2] )

virtual

Reimplemented from Trajectory.

Definition at line 638 of file TrkDifPieceTraj.cxx.

{
  double oldend;
  double lrange[2];
  TrkSimpTraj* trajpiece;
//
//  Check for pathological cases
//
  if( newrange[1] > newrange[0] &&
      newrange[0] < flightrange[1] &&
      newrange[1] > flightrange[0] ) {
    resize(newrange[0],trkIn);
    resize(newrange[1],trkOut);
  } else if(newrange[1] < newrange[0] ){
#ifdef MDCPATREC_ERROR 
    std::cout<<"ErrMsg(error) "<< "cannot resize -- invalid range" << std::endl;
#endif
  } else {
//
//  Here the new range is completely discontinuous from the
//  old.  We'll just take the first (or last) traj piece,
//  clear out everything else, and reset the ranges.
//
    if( newrange[0] > flightrange[1]){
      while(_localtraj.size()>1){
        trajpiece = _localtraj.front(); _localtraj.pop_front();
        delete trajpiece;
        oldend = _globalrange.front(); _globalrange.pop_front();
      }
    } else {
      while(_localtraj.size()>1){
        trajpiece = _localtraj.back(); _localtraj.pop_back();
        delete trajpiece;
        oldend = _globalrange.back(); _globalrange.pop_back();
      }
    }
    lrange[0] = localDist(0,newrange[0]);
    lrange[1] = localDist(0,newrange[1]);
    flightrange[0] = newrange[0];
    flightrange[1] = newrange[1];
    _globalrange[0] = newrange[0];
    _globalrange[1] = newrange[1];
    _localtraj[0]->setFlightRange(lrange);
  }
}

Referenced by TrkDifPieceTraj().

◆ trajIndex()

int TrkDifPieceTraj::trajIndex	(	const double &	global,
		double &	local ) const

protected

Definition at line 371 of file TrkDifPieceTraj.cxx.

{
  int index(0); // true when there's only 1 entry
  if (_localtraj.size() > 1) {
    if(validFlightDistance(flightdist)){
//   explicitly check cached value from last call
      if ( _lastIndex >= 0 && _lastIndex <  _localtraj.size()-1 &&
           flightdist > _globalrange[_lastIndex] && flightdist <
           _globalrange[_lastIndex+1] ) {
        index = _lastIndex;
      } else {
//
//  simple binary search algorithm
//
        int hirange = _localtraj.size() - 1;
        int lorange = 0;
        index = hirange/2;
        int oldindex = -1;
        while(index != oldindex){
          oldindex = index;
          if(flightdist < _globalrange[index]){
            hirange = index;
            index -= max(1,(index-lorange)/2);
          } else if(flightdist > _globalrange[index+1]){
            lorange = index;
            index += max(1,(hirange-index)/2);
          }
        }
      }
    } else {
//
//  Return the appropriate end if the requested flightdistance is outside the
//  global range
//
      index = (flightdist < lowRange()?0:(_localtraj.size()-1));
    }
  }
  localflight =  localDist(index,flightdist);
// cache value for next time
  _lastIndex = index;
  return index;
}

Referenced by append(), distTo1stError(), distTo2ndError(), localTrajectory(), prepend(), and resize().

Member Data Documentation

◆ _globalrange

std::deque<double> TrkDifPieceTraj::_globalrange

protected

Definition at line 137 of file TrkDifPieceTraj.h.

Referenced by append(), append(), distTo1stError(), distTo2ndError(), globalDist(), invert(), localDist(), operator=(), operator==(), prepend(), prepend(), printAll(), resize(), setFlightRange(), trajIndex(), TrkDifPieceTraj(), TrkDifPieceTraj(), and TrkDifPieceTraj().

◆ _lastIndex

int TrkDifPieceTraj::_lastIndex

mutableprotected

Definition at line 138 of file TrkDifPieceTraj.h.

Referenced by trajIndex().

◆ _localtraj

std::deque<TrkSimpTraj*> TrkDifPieceTraj::_localtraj

protected

Definition at line 136 of file TrkDifPieceTraj.h.

Referenced by append(), append(), distTo1stError(), distTo2ndError(), globalDist(), invert(), localDist(), localTrajectory(), operator=(), operator==(), prepend(), prepend(), print(), printAll(), resize(), setFlightRange(), trajIndex(), TrkDifPieceTraj(), TrkDifPieceTraj(), TrkDifPieceTraj(), TrkDifPieceTraj(), and ~TrkDifPieceTraj().

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

Public Member Functions

Protected Member Functions

Protected Attributes

Detailed Description

Constructor & Destructor Documentation

◆ TrkDifPieceTraj() [1/4]

◆ TrkDifPieceTraj() [2/4]

◆ TrkDifPieceTraj() [3/4]

◆ TrkDifPieceTraj() [4/4]

◆ ~TrkDifPieceTraj()

Member Function Documentation

◆ append() [1/4]

◆ append() [2/4]

◆ append() [3/4]

◆ append() [4/4]

◆ clone()

◆ curvature()

◆ delDirect()

◆ derivDeflect()

◆ derivDisplace()

◆ derivPFract()

◆ direction()

◆ distTo1stError()

◆ distTo2ndError()

◆ getDFInfo()

◆ getDFInfo2()

◆ getInfo() [1/2]

◆ getInfo() [2/2]

◆ globalDist()

◆ invert()

◆ localDist()

◆ locallyValid()

◆ localTrajectory()

◆ operator=()

◆ operator==()

◆ position()

◆ prepend() [1/4]

◆ prepend() [2/4]

◆ prepend() [3/4]

◆ prepend() [4/4]

◆ print()

◆ printAll()

◆ resize()

◆ setFlightRange()

◆ trajIndex()

Member Data Documentation

◆ _globalrange

◆ _lastIndex

◆ _localtraj