newBasic2DVector.h

Go to the documentation of this file.

#ifndef GeometryVector_newBasic2DVector_h
#define GeometryVector_newBasic2DVector_h

#include "DataFormats/GeometryVector/interface/Phi.h"
#include "DataFormats/GeometryVector/interface/PreciseFloatType.h"
#include "DataFormats/GeometryVector/interface/CoordinateSets.h"
#include "DataFormats/Math/interface/SSEVec.h"


#include <cmath>
#include <iosfwd>


template < class T> 
class Basic2DVector {
public:

  typedef T    ScalarType;
  typedef mathSSE::Vec2<T> VectorType;
  typedef mathSSE::Vec2<T> MathVector;
  typedef Geom::Polar2Cartesian<T>        Polar;

  Basic2DVector() {}

  Basic2DVector( const Basic2DVector & p) : v(p.v) {}

  template<typename U>
  Basic2DVector( const Basic2DVector<U> & p) : v(p.v) {}


  template <class Other> 
  explicit Basic2DVector( const Other& p) : v(p.x(),p.y()) {}

  Basic2DVector( const T& x, const T& y) : v(x,y) {}

  // constructor from Vec2 or vec4
  template<typename U>
  Basic2DVector(mathSSE::Vec2<U> const& iv) : v(iv){}
  template<typename U>
  Basic2DVector(mathSSE::Vec4<U> const& iv) : v(iv.xy()){}

  MathVector const & mathVector() const { return v;}
  MathVector & mathVector() { return v;}


  T x() const { return v[0];}

  T y() const { return v[1];}

  T mag2() const { return ::dot(v,v);}

  T mag() const  { return std::sqrt( mag2());}

  T r() const    { return mag();}

  T barePhi() const {return std::atan2(y(),x());}
  Geom::Phi<T> phi() const {return Geom::Phi<T>(atan2(y(),x()));}

  Basic2DVector unit() const {
    T my_mag = mag();
    return my_mag == 0 ? *this : *this / my_mag;
  }

  template <class U> 
  Basic2DVector& operator+= ( const Basic2DVector<U>& p) {
    v = v + p.v;
    return *this;
  } 

  template <class U> 
  Basic2DVector& operator-= ( const Basic2DVector<U>& p) {
    v = v - p.v;
    return *this;
  } 

  Basic2DVector operator-() const { return Basic2DVector(-v);}

  Basic2DVector& operator*= ( T t) {
    v = v*t;
    return *this;
  } 

  Basic2DVector& operator/= ( T t) {
    t = T(1)/t;
    v = v*t;
    return *this;
  } 

  T dot( const Basic2DVector& lh) const { return ::dot(v,lh.v);}

  template <class U> 
  typename PreciseFloatType<T,U>::Type dot( const Basic2DVector<U>& lh) const { 
    return Basic2DVector<typename PreciseFloatType<T,U>::Type>(*this)
      .dot(Basic2DVector<typename PreciseFloatType<T,U>::Type>(lh));
  }

  T cross( const Basic2DVector& lh) const { return ::cross(v,lh.v);}

  template <class U> 
  typename PreciseFloatType<T,U>::Type cross( const Basic2DVector<U>& lh) const { 
    return Basic2DVector<typename PreciseFloatType<T,U>::Type>(*this)
      .cross(Basic2DVector<typename PreciseFloatType<T,U>::Type>(lh));
  }


public:

  mathSSE::Vec2<T> v;

};


namespace geometryDetails {
  std::ostream & print2D(std::ostream& s, double x, double y);

}

template <class T>
inline std::ostream & operator<<( std::ostream& s, const Basic2DVector<T>& v) {
  return geometryDetails::print2D(s, v.x(),v.y());
}


template <class T>
inline Basic2DVector<T>
operator+( const Basic2DVector<T>& a, const Basic2DVector<T>& b) {
  return a.v+b.v;
}
template <class T>
inline Basic2DVector<T>
operator-( const Basic2DVector<T>& a, const Basic2DVector<T>& b) {
  return a.v-b.v;
}

template <class T, class U>
inline Basic2DVector<typename PreciseFloatType<T,U>::Type>
operator+( const Basic2DVector<T>& a, const Basic2DVector<U>& b) {
  typedef Basic2DVector<typename PreciseFloatType<T,U>::Type> RT;
  return RT(a) + RT(b);
}

template <class T, class U>
inline Basic2DVector<typename PreciseFloatType<T,U>::Type>
operator-( const Basic2DVector<T>& a, const Basic2DVector<U>& b) {
  typedef Basic2DVector<typename PreciseFloatType<T,U>::Type> RT;
  return RT(a)-RT(b);
}




// scalar product of vectors of same precision
template <class T>
inline T operator*( const Basic2DVector<T>& v1, const Basic2DVector<T>& v2) {
  return v1.dot(v2);
}

template <class T, class U>
inline typename PreciseFloatType<T,U>::Type operator*( const Basic2DVector<T>& v1, 
                               const Basic2DVector<U>& v2) {
  return v1.dot(v2);
}


template <class T>
inline Basic2DVector<T> operator*( const Basic2DVector<T>& v, T t) {
  return v.v*t;
}

template <class T>
inline Basic2DVector<T> operator*(T t, const Basic2DVector<T>& v) {
  return v.v*t;
}



template <class T, class Scalar>
inline Basic2DVector<T> operator*( const Basic2DVector<T>& v, const Scalar& s) {
  T t = static_cast<T>(s);
  return v*t;
}

template <class T, class Scalar>
inline Basic2DVector<T> operator*( const Scalar& s, const Basic2DVector<T>& v) {
  T t = static_cast<T>(s);
  return v*t;
}

template <class T>
inline Basic2DVector<T> operator/(const Basic2DVector<T>& v, T t) {
  return v.v/t;
}

template <class T, class Scalar>
inline Basic2DVector<T> operator/( const Basic2DVector<T>& v, const Scalar& s) {
  //   T t = static_cast<T>(Scalar(1)/s); return v*t;
   T t = static_cast<T>(s);
  return v/t;
}

typedef Basic2DVector<float> Basic2DVectorF;
typedef Basic2DVector<double> Basic2DVectorD;


#endif // GeometryVector_Basic2DVector_h