/* Copyright 2008-2010, Technische Universitaet Muenchen,
   Authors: Christian Hoeppner & Sebastian Neubert

   This file is part of GENFIT.

   GENFIT is free software: you can redistribute it and/or modify
   it under the terms of the GNU Lesser General Public License as published
   by the Free Software Foundation, either version 3 of the License, or
   (at your option) any later version.

   GENFIT is distributed in the hope that it will be useful,
   but WITHOUT ANY WARRANTY; without even the implied warranty of
   MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
   GNU Lesser General Public License for more details.

   You should have received a copy of the GNU Lesser General Public License
   along with GENFIT.  If not, see <http://www.gnu.org/licenses/>.
*/
#include "GFAbsTrackRep.h"
#include <iostream>
#include <assert.h>

GFAbsTrackRep::GFAbsTrackRep() : fDimension(5),fState(5,1), fCov(5,5), fChiSqu(0), fNdf(0), fStatusFlag(0), fInverted(false), fFirstState(5,1), fFirstCov(5,5), fLastState(5,1), fLastCov(5,5)
{
}

GFAbsTrackRep::GFAbsTrackRep(int dim) : fDimension(dim), fState(dim,1), fCov(dim,dim), fChiSqu(0), fNdf(0), fStatusFlag(0), fInverted(false), fFirstState(dim,1), fFirstCov(dim,dim), fLastState(dim,1), fLastCov(dim,dim)
{
}

GFAbsTrackRep::~GFAbsTrackRep() {}

double GFAbsTrackRep::extrapolate(const GFDetPlane& plane){
  TMatrixT<double> statePred(fDimension,1);
  TMatrixT<double> covPred(fDimension,fDimension);
  double retVal = extrapolate(plane,statePred,covPred);
  setData(statePred,plane,&covPred);
  return retVal;
}

//default implentation might be overwritten, please see the doxy docu
double GFAbsTrackRep::extrapolate(const GFDetPlane& plane, TMatrixT<double>& statePred){
  TMatrixT<double> cov(fDimension,fDimension);
  return extrapolate(plane,statePred,cov);
}

void GFAbsTrackRep::Abort(std::string method){
  std::cerr << method <<  " as implemented in " << __FILE__ 
	    << " was called. This means that this feature was used "
	    << "in a track rep which didnt overwrite this method. "
	    << std::endl << "C++ throw;" << std::endl;
  //system call abort
  throw;
}

void GFAbsTrackRep::extrapolateToPoint(const TVector3&,  //(const TVector3& point,
				    TVector3&,//TVector3& poca,
				    TVector3&){//TVector3& normVec
  Abort("extrapolateToPoca()");
}

void GFAbsTrackRep::extrapolateToLine(const TVector3& , //(const TVector3& point1,
									const TVector3& ,//const TVector3& point2,
									TVector3& ,//TVector3& poca,
									TVector3& ,//TVector3& normVec,
									TVector3& ){//TVector3& poca_onwire){
  Abort("extrapolateToLine()");
}
  

double GFAbsTrackRep::stepalong(double ,//(double h,
                  TVector3& ,//TVector3& point,
                  TVector3& ){//TVector3& dir){
  Abort("stepalong()");
  return -1.;
}


void GFAbsTrackRep::getPosMomCov(const GFDetPlane& ,TVector3& ,TVector3& ,TMatrixT<double>& ){//const GFDetPlane& pl,TVector3& pos,TVector3& mom,TMatrixT<double>& cov
  Abort("getPosMomCov()");
}

void
GFAbsTrackRep::reset(){
  std::cout<<"GFAbsTrackRep::reset"<<std::endl;
  TVector3 nullVec(0.,0.,0.);
  fRefPlane.set(nullVec,nullVec,nullVec);
  fState.Zero();
  fCov.Zero();
  fFirstState.Zero();
  fFirstCov.Zero();
  fLastState.Zero();
  fLastCov.Zero();
}

void
GFAbsTrackRep::Print() const {
  std::cout << "++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++" << std::endl;
  std::cout<<"GFAbsTrackRep::Parameters at reference plane ";
  fRefPlane.Print();
  std::cout<<"GFAbsTrackRep::State"<<std::endl;
  fState.Print();
  std::cout<<"GFAbsTrackRep::Covariances"<<std::endl;
  fCov.Print();
  std::cout<<"GFAbsTrackRep::chi^2"<<std::endl;
  std::cout<<fChiSqu<<std::endl;
  std::cout << "++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++" << std::endl;
}



ClassImp(GFAbsTrackRep)