TrkDifPieceTraj Class Reference

#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 ()
virtual void	getDFInfo (double fltLen, DifPoint &pos, DifVector &direction, DifVector &delDirect) const =0
virtual void	getDFInfo2 (double fltLen, DifPoint &pos, DifVector &direction) const
virtual const TrkSimpTraj *	localTrajectory (double fltLen, double &localFlt) const =0
Public Member Functions inherited from Trajectory
	Trajectory (double lowlim, double hilim)
virtual	~Trajectory ()
virtual HepPoint3D	position (double) const =0
virtual Hep3Vector	direction (double) const =0
virtual Hep3Vector	delDirect (double) const =0
virtual double	curvature (double) const =0
virtual void	getInfo (double fltLen, HepPoint3D &pos, Hep3Vector &direction) const =0
virtual void	getInfo (double fltLen, HepPoint3D &pos, Hep3Vector &direction, Hep3Vector &delDirect) const =0
double	distTo0thError (double s, double tol, int pathDir) const
virtual double	distTo1stError (double s, double tol, int pathDir) const =0
virtual double	distTo2ndError (double s, double tol, int pathDir) const =0
virtual Trajectory *	clone () const =0
bool	validFlightDistance (double f, double tolerance=0.0) const
virtual void	setFlightRange (double newrange[2])
double	lowRange () const
double	hiRange () const
double	range () const
virtual void	print (std::ostream &os) const
virtual void	printAll (std::ostream &os) const
virtual HepMatrix	derivDeflect (double fltlen, deflectDirection idir) const =0
virtual HepMatrix	derivDisplace (double fltlen, deflectDirection idir) const =0
virtual HepMatrix	derivPFract (double fltlen) const =0

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);
}

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(), 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.

{return new TrkDifPieceTraj(*this); }

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(), 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(), 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(), 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);
  }
}

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(), distTo1stError(), distTo2ndError(), globalDist(), invert(), localDist(), operator=(), operator==(), prepend(), printAll(), resize(), setFlightRange(), trajIndex(), 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(), distTo1stError(), distTo2ndError(), globalDist(), invert(), localDist(), localTrajectory(), operator=(), operator==(), prepend(), print(), printAll(), resize(), setFlightRange(), trajIndex(), TrkDifPieceTraj(), and ~TrkDifPieceTraj().

---

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

• TrkDifPieceTraj.h
• TrkDifPieceTraj.cxx