#ifndef RIVET_MATH_VECTOR2
#define RIVET_MATH_VECTOR2

#include "Rivet/Math/MathConstants.hh"
#include "Rivet/Math/MathUtils.hh"
#include "Rivet/Math/VectorN.hh"

namespace Rivet {


  class Vector2;
  typedef Vector2 TwoVector;
  typedef Vector2 V2;

  //class Matrix2;

  Vector2 multiply(const double, const Vector2&);
  Vector2 multiply(const Vector2&, const double);
  Vector2 add(const Vector2&, const Vector2&);
  Vector2 operator*(const double, const Vector2&);
  Vector2 operator*(const Vector2&, const double);
  Vector2 operator/(const Vector2&, const double);
  Vector2 operator+(const Vector2&, const Vector2&);
  Vector2 operator-(const Vector2&, const Vector2&);


  class Vector2 : public Vector<2> {

    // friend class Matrix2;
    friend Vector2 multiply(const double, const Vector2&);
    friend Vector2 multiply(const Vector2&, const double);
    friend Vector2 add(const Vector2&, const Vector2&);
    friend Vector2 subtract(const Vector2&, const Vector2&);

  public:
    Vector2() : Vector<2>() { }

    template<typename V2TYPE>
    Vector2(const V2TYPE& other) {
      this->setX(other.x());
      this->setY(other.y());
    }

    Vector2(const Vector<2>& other) {
      this->setX(other.get(0));
      this->setY(other.get(1));
    }

    Vector2(double x, double y) {
      this->setX(x);
      this->setY(y);
    }

    ~Vector2() { }


  public:

    static Vector2 mkX() { return Vector2(1,0); }
    static Vector2 mkY() { return Vector2(0,1); }


  public:

    double x() const { return get(0); }
    double y() const { return get(1); }
    Vector2& setX(double x) { set(0, x); return *this; }
    Vector2& setY(double y) { set(1, y); return *this; }


    double dot(const Vector2& v) const {
      return _vec.dot(v._vec);
    }

    double angle(const Vector2& v) const {
      const double localDotOther = unit().dot(v.unit());
      if (localDotOther > 1.0) return 0.0;
      if (localDotOther < -1.0) return M_PI;
      return acos(localDotOther);
    }


    Vector2 unitVec() const {
      double md = mod();
      if ( md <= 0.0 ) return Vector2();
      else return *this * 1.0/md;
    }

    Vector2 unit() const {
      return unitVec();
    }


  public:
    Vector2& operator*=(const double a) {
      _vec = multiply(a, *this)._vec;
      return *this;
    }

    Vector2& operator/=(const double a) {
      _vec = multiply(1.0/a, *this)._vec;
      return *this;
    }

    Vector2& operator+=(const Vector2& v) {
      _vec = add(*this, v)._vec;
      return *this;
    }

    Vector2& operator-=(const Vector2& v) {
      _vec = subtract(*this, v)._vec;
      return *this;
    }

    Vector2 operator-() const {
      Vector2 rtn;
      rtn._vec = -_vec;
      return rtn;
    }

  };



  inline double dot(const Vector2& a, const Vector2& b) {
    return a.dot(b);
  }

  inline Vector2 multiply(const double a, const Vector2& v) {
    Vector2 result;
    result._vec = a * v._vec;
    return result;
  }

  inline Vector2 multiply(const Vector2& v, const double a) {
    return multiply(a, v);
  }

  inline Vector2 operator*(const double a, const Vector2& v) {
    return multiply(a, v);
  }

  inline Vector2 operator*(const Vector2& v, const double a) {
    return multiply(a, v);
  }

  inline Vector2 operator/(const Vector2& v, const double a) {
    return multiply(1.0/a, v);
  }

  inline Vector2 add(const Vector2& a, const Vector2& b) {
    Vector2 result;
    result._vec = a._vec + b._vec;
    return result;
  }

  inline Vector2 subtract(const Vector2& a, const Vector2& b) {
    Vector2 result;
    result._vec = a._vec - b._vec;
    return result;
  }

  inline Vector2 operator+(const Vector2& a, const Vector2& b) {
    return add(a, b);
  }

  inline Vector2 operator-(const Vector2& a, const Vector2& b) {
    return subtract(a, b);
  }

  inline double angle(const Vector2& a, const Vector2& b) {
    return a.angle(b);
  }


}

#endif