OpenPaperOpt/V2.h

Go to the documentation of this file.

#ifndef V2_H
#define V2_H


#include <math.h>

#ifndef PI
#define PI 3.1415926535897932384626433832795
#endif

template <class T>
class V2{
private:
        T x, y;

public:
        V2() : x(0), y(0) {}
        V2(const T _x, const T _y) : x(_x), y(_y) {}
        V2(const V2 <T>& v) : x(v.x), y(v.y) {}

        T X()      const { return x; }
        T Y()      const { return y; }
        T P(int i) const {
                switch (i) {
                        case 0: return x;
                        case 1: return y;
                        default: return 0;
                }
        }

        void X(T _x) { x = _x; }
        void Y(T _y) { y = _y; }

        void NormalizeVector(){
                double temp = sqrt(x*x + y*y);
                if (temp!=0){
                        x /= temp;
                        y /= temp;
                }
        }

        T LengthVector() { return sqrt(x*x + y*y); }
        T LengthVector2() { return x*x + y*y; }

        V2 <T> &    Rotate90()     {T t=x;x=-y;y=t;return *this;}       

        void operator+=(const V2 <T> & v) { x += v.x; y += v.y; }
        void operator-=(const V2 <T> & v) { x -= v.x; y -= v.y; }
        void operator*=(const V2 <T> & v) { x *= v.x; y *= v.y; }
        void operator/=(const V2 <T> & v) { x/=v.x; y/=v.y; }

        void operator*=(T f)     {x*=f;y*=f;}   
    void operator/=(T f)     {operator*=((T)(1.0/f));}  
    V2 <T> operator-(void) const   {return V2 <T> (-x,-y);}     

        void VectDivConst(const double& v) { x /= v; y /= v; }
        void VectMulConst(const double& v) { x *= v; y *= v; }

};
template <class T>
inline V2 <T>  operator+(const V2 <T> & a,const V2 <T> & b) {
        return V2 <T> (a.X()+b.X(),a.Y()+b.Y());
}
template <class T>
inline V2 <T> operator-(const V2 <T> & a,const V2 <T> & b){
        return V2 <T> (a.X()-b.X(),a.Y()-b.Y());
}
template <class T>
inline T operator*(const V2 <T> & a,const V2 <T> & b) {
        return a.X()*b.X()+a.Y()*b.Y();
}
template <class T>
inline V2 <T> operator*(const V2 <T> & a,T f){
        return V2 <T> (a.X()*f,a.Y()*f);
}
template <class T>
inline V2 <T> operator/(const V2 <T> & a,T f){
        return a*(T)(1.0/f);
}

template <class T>
inline V2 <T> elemMul(const V2 <T> & a,const V2 <T>& b){
        return V2 <T> (a.X()*b.X(),a.Y()*b.Y());
}

template <class T>
inline int CrossLineToLineseg(const V2 <T>& a1,const V2 <T>& a2,const V2<T>& b1,const V2 <T>& b2) {


  T nX=a1.Y()-a2.Y();//Get a normal of first linesegment
  T nY=a2.X()-a1.X();
  T d=nX*a1.X()+nY*a1.Y(); //Calc d in line equation n*p=d
  T left =nX*b1.X()+nY*b1.Y()-d; //Calc (n*b1-d)*(n*b2-d). If result is negative 
  T right=nX*b2.X()+nY*b2.Y()-d;
  return (left*right<0)? 1:0;
}

#define AREA(V1,V2,V3,V4) (fabs(0.5*((V1).X()*(V2).Y()+(V2).X()*(V3).Y()+(V3).X()*(V4).Y()+(V4).X()*(V1).Y()-(V2).X()*(V1).Y()-(V3).X()*(V2).Y()-(V4).X()*(V3).Y()-(V1).X()*(V4).Y())))

//First vector is 0,0
#define AREA0(V2,V3,V4) (fabs(0.5*((V2).X()*(V3).Y()+(V3).X()*(V4).Y()-(V3).X()*(V2).Y()-(V4).X()*(V3).Y())))

//----------------------------------------------------------------------------------------

#endif