vector2d.hpp

// Copyright (C) 2002-2012 Nikolaus Gebhardt
// This file is part of the "Irrlicht Engine".
// For conditions of distribution and use, see copyright notice in duckcpp/duckcpp.hpp
 
#ifndef DCPP_POINT_2D_HPP_INCLUDED
#define DCPP_POINT_2D_HPP_INCLUDED
 
#include <duckcpp/core/engine/irrMath.hpp>
#include <duckcpp/core/engine/dimension2d.hpp>
 
namespace dcpp
{
namespace nub
{
 
 
 
template <class T>
class vector2d
{
public:
    vector2d() : X(0), Y(0) {}
    vector2d(T nx, T ny) : X(nx), Y(ny) {}
    vector2d(T n) : X(n), Y(n) {}
 
    vector2d(const dimension2d<T>& other) : X(other.Width), Y(other.Height) {}
 
    // operators
 
    vector2d<T> operator-() const { return vector2d<T>(-X, -Y); }
 
    vector2d<T>& operator=(const dimension2d<T>& other) { X = other.Width; Y = other.Height; return *this; }
 
    vector2d<T> operator+(const vector2d<T>& other) const { return vector2d<T>(X + other.X, Y + other.Y); }
    vector2d<T> operator+(const dimension2d<T>& other) const { return vector2d<T>(X + other.Width, Y + other.Height); }
    vector2d<T>& operator+=(const vector2d<T>& other) { X+=other.X; Y+=other.Y; return *this; }
    vector2d<T> operator+(const T v) const { return vector2d<T>(X + v, Y + v); }
    vector2d<T>& operator+=(const T v) { X+=v; Y+=v; return *this; }
    vector2d<T>& operator+=(const dimension2d<T>& other) { X += other.Width; Y += other.Height; return *this;  }
 
    vector2d<T> operator-(const vector2d<T>& other) const { return vector2d<T>(X - other.X, Y - other.Y); }
    vector2d<T> operator-(const dimension2d<T>& other) const { return vector2d<T>(X - other.Width, Y - other.Height); }
    vector2d<T>& operator-=(const vector2d<T>& other) { X-=other.X; Y-=other.Y; return *this; }
    vector2d<T> operator-(const T v) const { return vector2d<T>(X - v, Y - v); }
    vector2d<T>& operator-=(const T v) { X-=v; Y-=v; return *this; }
    vector2d<T>& operator-=(const dimension2d<T>& other) { X -= other.Width; Y -= other.Height; return *this;  }
 
    vector2d<T> operator*(const vector2d<T>& other) const { return vector2d<T>(X * other.X, Y * other.Y); }
    vector2d<T>& operator*=(const vector2d<T>& other) { X*=other.X; Y*=other.Y; return *this; }
    vector2d<T> operator*(const T v) const { return vector2d<T>(X * v, Y * v); }
    vector2d<T>& operator*=(const T v) { X*=v; Y*=v; return *this; }
 
    vector2d<T> operator/(const vector2d<T>& other) const { return vector2d<T>(X / other.X, Y / other.Y); }
    vector2d<T>& operator/=(const vector2d<T>& other) { X/=other.X; Y/=other.Y; return *this; }
    vector2d<T> operator/(const T v) const { return vector2d<T>(X / v, Y / v); }
    vector2d<T>& operator/=(const T v) { X/=v; Y/=v; return *this; }
 
    T& operator [](dcpp::uint32_kt index)
    {
        DCPP_DEBUG_BREAK_IF(index>1) // access violation
 
        return *(&X+index);
    }
 
    const T& operator [](dcpp::uint32_kt index) const
    {
        DCPP_DEBUG_BREAK_IF(index>1) // access violation
 
        return *(&X+index);
    }
 
    bool operator<=(const vector2d<T>&other) const
    {
        return (X<other.X || dcpp::nub::equals(X, other.X)) ||
                (dcpp::nub::equals(X, other.X) && (Y<other.Y || dcpp::nub::equals(Y, other.Y)));
    }
 
    bool operator>=(const vector2d<T>&other) const
    {
        return (X>other.X || dcpp::nub::equals(X, other.X)) ||
                (dcpp::nub::equals(X, other.X) && (Y>other.Y || dcpp::nub::equals(Y, other.Y)));
    }
 
    bool operator<(const vector2d<T>&other) const
    {
        return (X<other.X && !dcpp::nub::equals(X, other.X)) ||
                (dcpp::nub::equals(X, other.X) && Y<other.Y && !dcpp::nub::equals(Y, other.Y));
    }
 
    bool operator>(const vector2d<T>&other) const
    {
        return (X>other.X && !dcpp::nub::equals(X, other.X)) ||
                (dcpp::nub::equals(X, other.X) && Y>other.Y && !dcpp::nub::equals(Y, other.Y));
    }
 
    bool operator==(const vector2d<T>& other) const { return equals(other); }
    bool operator!=(const vector2d<T>& other) const { return !equals(other); }
 
    // functions
 
 
    bool equals(const vector2d<T>& other, const T tolerance = (T)ROUNDING_ERROR_Float32 ) const
    {
        return dcpp::nub::equals(X, other.X, tolerance) && dcpp::nub::equals(Y, other.Y, tolerance);
    }
 
    vector2d<T>& set(T nx, T ny) {X=nx; Y=ny; return *this; }
    vector2d<T>& set(const vector2d<T>& p) { X=p.X; Y=p.Y; return *this; }
 
 
    T getLength() const { return dcpp::nub::squareroot( X*X + Y*Y ); }
 
 
    T getLengthSQ() const { return X*X + Y*Y; }
 
 
    T dotProduct(const vector2d<T>& other) const
    {
        return X*other.X + Y*other.Y;
    }
 
    bool nearlyParallel( const vector2d<T> & other, const T factor = relativeErrorFactor<T>()) const
    {
        // https://eagergames.wordpress.com/2017/04/01/fast-parallel-lines-and-vectors-test/
        // if a || b then  a.x/a.y = b.x/b.y (similiar triangles)
        // if a || b then either both x are 0 or both y are 0.
 
        return  equalsRelative( X*other.Y, other.X* Y, factor)
        && // a bit counterintuitive, but makes sure  that
           // only y or only x are 0, and at same time deals
           // with the case where one vector is zero vector.
            (X*other.X + Y*other.Y) != 0;
    }
 
 
    T getDistanceFrom(const vector2d<T>& other) const
    {
        return vector2d<T>(X - other.X, Y - other.Y).getLength();
    }
 
 
    T getDistanceFromSQ(const vector2d<T>& other) const
    {
        return vector2d<T>(X - other.X, Y - other.Y).getLengthSQ();
    }
 
 
    vector2d<T>& rotateBy(dcpp::float64_kt degrees, const vector2d<T>& center=vector2d<T>())
    {
        degrees *= DEGTORAD64;
        const dcpp::float64_kt cs = cos(degrees);
        const dcpp::float64_kt sn = sin(degrees);
 
        X -= center.X;
        Y -= center.Y;
 
        set((T)(X*cs - Y*sn), (T)(X*sn + Y*cs));
 
        X += center.X;
        Y += center.Y;
        return *this;
    }
 
 
    vector2d<T>& normalize()
    {
        dcpp::float32_kt length = (dcpp::float32_kt)(X*X + Y*Y);
        if ( length == 0 )
            return *this;
        length = dcpp::nub::reciprocal_squareroot ( length );
        X = (T)(X * length);
        Y = (T)(Y * length);
        return *this;
    }
 
 
    dcpp::float64_kt getAngleTrig() const
    {
        if (Y == 0)
            return X < 0 ? 180 : 0;
        else
        if (X == 0)
            return Y < 0 ? 270 : 90;
 
        if ( Y > 0)
            if (X > 0)
                return atan((dcpp::float64_kt)Y/(dcpp::float64_kt)X) * RADTODEG64;
            else
                return 180.0-atan((dcpp::float64_kt)Y/-(dcpp::float64_kt)X) * RADTODEG64;
        else
            if (X > 0)
                return 360.0-atan(-(dcpp::float64_kt)Y/(dcpp::float64_kt)X) * RADTODEG64;
            else
                return 180.0+atan(-(dcpp::float64_kt)Y/-(dcpp::float64_kt)X) * RADTODEG64;
    }
 
 
    inline dcpp::float64_kt getAngle() const
    {
        if (Y == 0) // corrected thanks to a suggestion by Jox
            return X < 0 ? 180 : 0;
        else if (X == 0)
            return Y < 0 ? 90 : 270;
 
        // don't use getLength here to avoid precision loss with dcpp::int32_kt vectors
        // avoid floating-point trouble as sqrt(y*y) is occasionally larger than y, so clamp
        const dcpp::float64_kt tmp = dcpp::nub::clamp(Y / sqrt((dcpp::float64_kt)(X*X + Y*Y)), -1.0, 1.0);
        const dcpp::float64_kt angle = atan( dcpp::nub::squareroot(1 - tmp*tmp) / tmp) * RADTODEG64;
 
        if (X>0 && Y>0)
            return angle + 270;
        else
        if (X>0 && Y<0)
            return angle + 90;
        else
        if (X<0 && Y<0)
            return 90 - angle;
        else
        if (X<0 && Y>0)
            return 270 - angle;
 
        return angle;
    }
 
 
    inline dcpp::float64_kt getAngleWith(const vector2d<T>& b) const
    {
        dcpp::float64_kt tmp = (dcpp::float64_kt)(X*b.X + Y*b.Y);
 
        if (tmp == 0.0)
            return 90.0;
 
        tmp = tmp / dcpp::nub::squareroot((dcpp::float64_kt)((X*X + Y*Y) * (b.X*b.X + b.Y*b.Y)));
        if (tmp < 0.0)
            tmp = -tmp;
        if ( tmp > 1.0 ) //   avoid floating-point trouble
            tmp = 1.0;
 
        return atan(sqrt(1 - tmp*tmp) / tmp) * RADTODEG64;
    }
 
 
    bool isBetweenPoints(const vector2d<T>& begin, const vector2d<T>& end) const
    {
        //             .  end
        //            /
        //           /
        //          /
        //         . begin
        //        -
        //       -
        //      . this point (am I inside or outside)?
        //
        if (begin.X != end.X)
        {
            return ((begin.X <= X && X <= end.X) ||
                    (begin.X >= X && X >= end.X));
        }
        else
        {
            return ((begin.Y <= Y && Y <= end.Y) ||
                    (begin.Y >= Y && Y >= end.Y));
        }
    }
 
 
    vector2d<T> getInterpolated(const vector2d<T>& other, dcpp::float64_kt d) const
    {
        const dcpp::float64_kt inv = 1.0f - d;
        return vector2d<T>((T)(other.X*inv + X*d), (T)(other.Y*inv + Y*d));
    }
 
 
    vector2d<T> getInterpolated_quadratic(const vector2d<T>& v2, const vector2d<T>& v3, dcpp::float64_kt d) const
    {
        // this*(1-d)*(1-d) + 2 * v2 * (1-d) + v3 * d * d;
        const dcpp::float64_kt inv = 1.0f - d;
        const dcpp::float64_kt mul0 = inv * inv;
        const dcpp::float64_kt mul1 = 2.0f * d * inv;
        const dcpp::float64_kt mul2 = d * d;
 
        return vector2d<T> ( (T)(X * mul0 + v2.X * mul1 + v3.X * mul2),
                    (T)(Y * mul0 + v2.Y * mul1 + v3.Y * mul2));
    }
 
    dcpp::int32_kt checkOrientation( const vector2d<T> & b, const vector2d<T> & c) const
    {
        // Example of clockwise points
        //
        //   ^ Y
        //   |       A
        //   |      . .
        //   |     .   .
        //   |    C.....B
        //   +---------------> X
 
        T val = (b.Y - Y) * (c.X - b.X) -
            (b.X - X) * (c.Y - b.Y);
 
        if (val == 0) return 0;  // colinear
 
        return (val > 0) ? 1 : 2; // clock or counterclock wise
    }
 
    inline bool areClockwise( const vector2d<T> & b, const vector2d<T> & c) const
    {
        T val = (b.Y - Y) * (c.X - b.X) -
            (b.X - X) * (c.Y - b.Y);
 
        return val > 0;
    }
 
    inline bool areCounterClockwise( const vector2d<T> & b, const vector2d<T> & c) const
    {
        T val = (b.Y - Y) * (c.X - b.X) -
            (b.X - X) * (c.Y - b.Y);
 
        return val < 0;
    }
 
 
    vector2d<T>& interpolate( const vector2d<T>& a, const vector2d<T>& b, dcpp::float64_kt d)
    {
        X = (T)((dcpp::float64_kt)b.X + ( ( a.X - b.X ) * d ));
        Y = (T)((dcpp::float64_kt)b.Y + ( ( a.Y - b.Y ) * d ));
        return *this;
    }
 
    T X;
 
    T Y;
};
 
    using vector2df = vector2d<dcpp::float32_kt>;
 
    using vector2di = vector2d<dcpp::int32_kt>;
 
    template<class S, class T>
    vector2d<T> operator*(const S scalar, const vector2d<T>& vector) { return vector*scalar; }
 
    // These methods are declared in dimension2d, but need definitions of vector2d
    template<class T>
    dimension2d<T>::dimension2d(const vector2d<T>& other) : Width(other.X), Height(other.Y) { }
 
    template<class T>
    bool dimension2d<T>::operator==(const vector2d<T>& other) const { return Width == other.X && Height == other.Y; }
 
} // end namespace nub
} // end namespace dcpp
 
#endif