paddle 0.1.0-beta.1

use crate::quicksilver_compat::geom::about_equal;
use crate::Scalar;
use rand::{
    distributions::{Distribution, Standard},
    Rng,
};
use serde::{Deserialize, Serialize};
use std::{
    cmp::{Eq, PartialEq},
    fmt,
    ops::{Add, AddAssign, Div, DivAssign, Mul, MulAssign, Neg, Sub, SubAssign},
};

#[derive(Copy, Clone, Default, Debug, Deserialize, Serialize)]
///A 2D vector with single-precision floating point numbers
pub struct Vector {
    ///The x coordinate of the vector
    pub x: f32,
    ///The y coordinate of the vector
    pub y: f32,
}

impl Vector {
    /// A vector with x = 0, y = 0
    pub const ZERO: Vector = Vector { x: 0f32, y: 0f32 };
    /// A vector with x = 1, y = 0
    pub const X: Vector = Vector { x: 1f32, y: 0f32 };
    /// A vector with x = 0, y = 1
    pub const Y: Vector = Vector { x: 0f32, y: 1f32 };
    /// A vector with x = 1, y = 1
    pub const ONE: Vector = Vector { x: 1f32, y: 1f32 };
}

impl Vector {
    ///Create a new vector
    pub fn new(x: impl Scalar, y: impl Scalar) -> Vector {
        Vector {
            x: x.float(),
            y: y.float(),
        }
    }

    ///Create a unit vector at a given angle
    pub fn from_angle<T: Scalar>(angle: T) -> Vector {
        Vector::new(
            angle.float().to_radians().cos(),
            angle.float().to_radians().sin(),
        )
    }

    ///Get the squared length of the vector (faster than getting the length)
    pub fn len2(self) -> f32 {
        self.x * self.x + self.y * self.y
    }

    ///Get the length of the vector
    pub fn len(self) -> f32 {
        self.len2().sqrt()
    }

    ///Clamp a vector somewhere between a minimum and a maximum
    #[must_use]
    pub fn clamp(self, min_bound: impl Into<Vector>, max_bound: impl Into<Vector>) -> Vector {
        let (min_bound, max_bound) = (min_bound.into(), max_bound.into());
        Vector::new(
            max_bound.x.min(min_bound.x.max(self.x)),
            max_bound.y.min(min_bound.y.max(self.y)),
        )
    }
    ///Get the cross product of a vector
    pub fn cross(self, other: impl Into<Vector>) -> f32 {
        let other = other.into();
        self.x * other.y - self.y * other.x
    }

    ///Get the dot product of a vector
    pub fn dot(self, other: impl Into<Vector>) -> f32 {
        let other = other.into();
        self.x * other.x + self.y * other.y
    }

    ///Normalize the vector's length from [0, 1]
    #[must_use]
    pub fn normalize(self) -> Vector {
        self / self.len()
    }

    ///Get only the X component of the Vector, represented as a vector
    #[must_use]
    pub fn x_comp(self) -> Vector {
        Vector::new(self.x, 0f32)
    }

    ///Get only the Y component of the Vector, represented as a vector
    #[must_use]
    pub fn y_comp(self) -> Vector {
        Vector::new(0f32, self.y)
    }

    ///Get the vector equal to Vector(1 / x, 1 / y)
    #[must_use]
    pub fn recip(self) -> Vector {
        Vector::new(self.x.recip(), self.y.recip())
    }

    ///Multiply the components in the matching places
    #[must_use]
    pub fn times(self, other: impl Into<Vector>) -> Vector {
        let other = other.into();
        Vector::new(self.x * other.x, self.y * other.y)
    }

    ///Get the angle a vector forms with the positive x-axis, counter clockwise
    pub fn angle(self) -> f32 {
        self.y.atan2(self.x).to_degrees()
    }

    ///Create a vector with the same angle and the given length
    #[must_use]
    pub fn with_len(self, length: f32) -> Vector {
        self.normalize() * length
    }

    ///Get the Euclidean distance to another vector
    pub fn distance(self, other: impl Into<Vector>) -> f32 {
        let other = other.into();
        ((other.x - self.x).powi(2) + (other.y - self.y).powi(2)).sqrt()
    }

    ///Get a vector with the minimum of each component of this and another vector
    pub fn min(self, other: impl Into<Vector>) -> Vector {
        let other = other.into();
        Vector::new(self.x.min(other.x), self.y.min(other.y))
    }

    ///Get a vector with the maximum of each component of this and another vector
    pub fn max(self, other: impl Into<Vector>) -> Vector {
        let other = other.into();
        Vector::new(self.x.max(other.x), self.y.max(other.y))
    }

    pub fn distance_2(&self, other: &Vector) -> f32 {
        let x = self.x - other.x;
        let y = self.y - other.y;
        x * x + y * y
    }
}

impl Neg for Vector {
    type Output = Vector;

    fn neg(self) -> Vector {
        Vector::new(-self.x, -self.y)
    }
}

impl Add for Vector {
    type Output = Vector;

    fn add(self, rhs: Vector) -> Vector {
        Vector::new(self.x + rhs.x, self.y + rhs.y)
    }
}

impl AddAssign for Vector {
    fn add_assign(&mut self, rhs: Vector) -> () {
        *self = *self + rhs;
    }
}

impl Sub for Vector {
    type Output = Vector;

    fn sub(self, rhs: Vector) -> Vector {
        self + (-rhs)
    }
}

impl SubAssign for Vector {
    fn sub_assign(&mut self, rhs: Vector) -> () {
        *self = *self - rhs;
    }
}

impl<T: Scalar> Div<T> for Vector {
    type Output = Vector;

    fn div(self, rhs: T) -> Vector {
        let rhs = rhs.float();
        Vector::new(self.x / rhs, self.y / rhs)
    }
}

impl<T: Scalar> DivAssign<T> for Vector {
    fn div_assign(&mut self, rhs: T) -> () {
        let rhs = rhs.float();
        *self = *self / rhs;
    }
}

impl<T: Scalar> Mul<T> for Vector {
    type Output = Vector;

    fn mul(self, rhs: T) -> Vector {
        let rhs = rhs.float();
        Vector::new(self.x * rhs, self.y * rhs)
    }
}

impl<T: Scalar> MulAssign<T> for Vector {
    fn mul_assign(&mut self, rhs: T) -> () {
        let rhs = rhs.float();
        *self = *self * rhs;
    }
}

impl PartialEq for Vector {
    fn eq(&self, other: &Vector) -> bool {
        about_equal(self.x, other.x) && about_equal(self.y, other.y)
    }
}

impl Eq for Vector {}

impl fmt::Display for Vector {
    fn fmt(&self, f: &mut fmt::Formatter) -> fmt::Result {
        write!(f, "<{}, {}>", self.x, self.y)
    }
}

impl Distribution<Vector> for Standard {
    fn sample<R: Rng + ?Sized>(&self, rand: &mut R) -> Vector {
        Vector {
            x: self.sample(rand),
            y: self.sample(rand),
        }
    }
}

impl<T: Scalar, U: Scalar> From<(T, U)> for Vector {
    fn from(other: (T, U)) -> Vector {
        Vector::new(other.0, other.1)
    }
}

#[cfg(test)]
mod tests {
    use crate::quicksilver_compat::about_equal;

    use super::Vector;

    #[test]
    fn arithmetic() {
        let a = Vector::new(5, 10);
        let b = Vector::new(1, -2);
        assert!((a + b).x == 6f32);
        assert!((a - b).y == 12f32);
    }

    #[test]
    fn equality() {
        assert_eq!(Vector::new(5, 5), Vector::new(5, 5));
        assert_ne!(Vector::new(0, 5), Vector::new(5, 5));
    }

    #[test]
    fn inverse() {
        let vec = Vector::new(3, 5);
        let inverse = vec.recip();
        assert_eq!(Vector::new(1.0 / 3.0, 1.0 / 5.0), inverse);
    }

    #[test]
    fn length() {
        let vec = Vector::X * 5;
        assert!(about_equal(vec.len2(), 25f32));
        assert!(about_equal(vec.len(), 5f32));
    }

    #[test]
    fn scale() {
        let vec = Vector::new(1, 1);
        let doubled = Vector::new(2, 2);
        assert_eq!(vec * 2, doubled);
        let halved = Vector::new(0.5, 0.5);
        assert_eq!(vec / 2, halved);
    }

    #[test]
    fn clamp() {
        let min = Vector::new(-10, -2);
        let max = Vector::new(5, 6);
        let vec = Vector::new(-11, 3);
        let clamped = vec.clamp(min, max);
        let expected = Vector::new(-10, 3);
        assert_eq!(clamped, expected);
    }

    #[test]
    fn dot() {
        assert!(about_equal(
            Vector::new(6, 5).dot(Vector::new(2, -8)),
            -28f32
        ));
    }

    #[test]
    fn times() {
        let vec = Vector::new(3, -2);
        let two = Vector::ONE * 2;
        assert_eq!(vec.times(two), vec * 2);
    }

    #[test]
    fn angle() {
        let a = Vector::X;
        let b = Vector::Y;
        let c = a + b;
        assert_eq!(a.angle(), 0.0);
        assert_eq!(b.angle(), 90.0);
        assert_eq!(c.angle(), 45.0);
    }

    #[test]
    fn distance() {
        let a = Vector::X;
        let b = Vector::Y;
        let c = a + b;
        assert_eq!(a.distance(a), 0.0);
        assert_eq!(a.distance(Vector::ZERO), 1.0);
        assert_eq!(b.distance(a), 2_f32.sqrt());
        assert_eq!(c.distance(Vector::ZERO), 2_f32.sqrt());
    }
}