BesVectorErr.cxx

Go to the documentation of this file.

//--------------------------------------------------------------------------
// File and Version Information:
//      $Id: BesVectorErr.cxx,v 1.3 2010/03/25 09:55:57 zhangy Exp $
//
// Description:
//      Class BbrVectorErr
//
// Environment:
//      Software developed for the BaBar Detector at the SLAC B-Factory.
//
// Author List:
//      Forest Rouse            February 1996
//      Victoria Novotny        August   1996
//
// Copyright Information:
//      Copyright (C) 1996      U.C. Davis
// 
// History:
//  Migration for BESIII MDC
//
// 2002/01/19, Sasha Telnov: added operator * (scaling by a real number) 
//
//------------------------------------------------------------------------
// File BbrVectorErr.cc
// Source file for class BbrVectorErr
//
// For advice, input, or any questions then please contact either
// Bob Jacobsen <[email protected]> or
// Forest Rouse <[email protected]>
//
// =====================================================================
// Name           Change description
// Date
// Version
// =====================================================================
 
//#include "BaBar/BaBar.h"
#include <float.h>
#include <iostream>
#include "MdcRecoUtil/BesVectorErr.h"
#include "MdcRecoUtil/DifNumber.h"
#include "MdcRecoUtil/DifArray.h"
using std::istream;
using std::ostream;
//#include "BesError.h"
 
 
//void BesVectorErr::printOn(ostream& out) const
//{
//    out << "Bes Vector and Covariance Matrix:" << endl;
//    BesVector::printOn(out);
//    out << endl;
//    out << _covMatrix;
//}
 
BesError BesVectorErr::covRTPMatrix() const{
  // protect against 0's
  double xv = x()==0 ?  FLT_MIN : x();
  double yv = y()==0 ?  FLT_MIN : y();
  double zv = z()==0 ?  FLT_MIN : z();
  DifNumber xDF(xv,X+1,3), yDF(yv,Y+1,3), zDF(zv,Z+1,3);
  DifArray pars(3,NUM_PCOORDINATES);
  pars[Rho]   =  sqrt(xDF*xDF + yDF*yDF + zDF*zDF);
  pars[Phi]   = atan2(yDF,xDF);
  pars[Theta] = acos(zDF/pars[Rho]);
  return covMatrix().similarity(pars.jacobian());
}
 
BesError BesVectorErr::covRZPMatrix() const{
  // protect against 0's
  double xv = x()==0 ?  FLT_MIN : x();
  double yv = y()==0 ?  FLT_MIN : y();
  double zv = z()==0 ?  FLT_MIN : z();
  DifNumber xDF(xv,X+1,3), yDF(yv,Y+1,3), zDF(zv,Z+1,3);
  DifArray pars(3,NUM_CCOORDINATES);
  pars[C_Rho]   =  sqrt(xDF*xDF + yDF*yDF);
  pars[C_Phi]   = atan2(yDF,xDF);
  pars[C_Zeta] = zDF;
  return covMatrix().similarity(pars.jacobian());
}
 
double BesVectorErr::determineChisq(const Hep3Vector& refVector) const
{
   HepVector temp(NUM_COORDINATES, 0);
   temp[0] = refVector.x()-this->x();
   temp[1] = refVector.y()-this->y();
   temp[2] = refVector.z()-this->z();
   return _covMatrix.determineChisq(temp);
}
 
 
BesVectorErr operator + (const BesVectorErr& v, const BesVectorErr& w){
    BesVectorErr ve(Hep3Vector(v.x()+w.x(),v.y()+w.y(),v.z()+w.z()),
            (v.covMatrix()+w.covMatrix()));
    return ve;
}
 
BesVectorErr operator - (const BesVectorErr& v, const BesVectorErr& w){
    BesVectorErr ve(Hep3Vector(v.x()-w.x(),v.y()-w.y(),v.z()-w.z()), 
                    (v.covMatrix()+w.covMatrix()));
    return ve;
}
 
// Added by Sasha Telnov
BesVectorErr operator * (const BesVectorErr & p, double a) {
  BesVectorErr ve(Hep3Vector(a*p.x(), a*p.y(), a*p.z()),
                  (p.covMatrix()*a*a));
  return ve;
}
 
BesVectorErr operator * (double a, const BesVectorErr & p) {
  BesVectorErr ve(Hep3Vector(a*p.x(), a*p.y(), a*p.z()),
                  (p.covMatrix()*a*a));
  return ve;
}
 
 
ostream & operator<<(ostream & stream, const BesVectorErr & verr) {
  stream << (const Hep3Vector&)verr
     << ", " << verr.covMatrix();
  
  return stream;
}
 
istream & operator>>(istream & stream, BesVectorErr & verr) {
  BesError mat(verr.SIZE);
  stream >> (Hep3Vector&)verr >> mat;
  verr.setCovMatrix(mat);
  
  return stream;
}