anathema-geometry 0.2.6

use std::ops::{Add, AddAssign, Mul, Sub, SubAssign};

use crate::Size;

// -----------------------------------------------------------------------------
//   - Generic position -
// -----------------------------------------------------------------------------

/// A position in global space.
/// Can contain negative coordinates
#[derive(Debug, Copy, Clone, PartialEq, Eq, Hash, PartialOrd)]
pub struct Pos {
    /// X coordinate
    pub x: i32,
    /// Y coordinate
    pub y: i32,
}

impl Pos {
    /// Zero
    pub const ZERO: Self = Self::new(0, 0);

    /// Create a new instance with the given x and y coordinates
    pub const fn new(x: i32, y: i32) -> Self {
        Self { x, y }
    }
}

impl Default for Pos {
    fn default() -> Self {
        Self::ZERO
    }
}

impl From<(i32, i32)> for Pos {
    fn from(val: (i32, i32)) -> Self {
        Self::new(val.0, val.1)
    }
}

impl From<(u16, u16)> for Pos {
    fn from(val: (u16, u16)) -> Self {
        Self::new(val.0 as i32, val.1 as i32)
    }
}

impl From<LocalPos> for Pos {
    fn from(LocalPos { x, y }: LocalPos) -> Self {
        Self::new(x as i32, y as i32)
    }
}

impl From<(usize, usize)> for Pos {
    fn from(val: (usize, usize)) -> Self {
        Self::new(val.0 as i32, val.1 as i32)
    }
}

impl Add for Pos {
    type Output = Self;

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

impl Add<Size> for Pos {
    type Output = Self;

    fn add(self, rhs: Size) -> Self::Output {
        Pos::new(self.x + rhs.width as i32, self.y + rhs.height as i32)
    }
}

impl Add<LocalPos> for Pos {
    type Output = Self;

    fn add(self, rhs: LocalPos) -> Self::Output {
        Pos::new(self.x + rhs.x as i32, self.y + rhs.y as i32)
    }
}

impl Sub<LocalPos> for Pos {
    type Output = Self;

    fn sub(self, rhs: LocalPos) -> Self::Output {
        Pos::new(self.x - rhs.x as i32, self.y - rhs.y as i32)
    }
}

impl Mul<f32> for Pos {
    type Output = Self;

    fn mul(self, rhs: f32) -> Self::Output {
        Self {
            x: (self.x as f32 * rhs).round() as i32,
            y: (self.y as f32 * rhs).round() as i32,
        }
    }
}

impl AddAssign for Pos {
    fn add_assign(&mut self, rhs: Pos) {
        self.x += rhs.x;
        self.y += rhs.y;
    }
}

impl Sub for Pos {
    type Output = Self;

    fn sub(self, rhs: Self) -> Self::Output {
        Pos::new(self.x - rhs.x, self.y - rhs.y)
    }
}

impl SubAssign for Pos {
    fn sub_assign(&mut self, rhs: Pos) {
        self.x -= rhs.x;
        self.y -= rhs.y;
    }
}

// -----------------------------------------------------------------------------
//   - Local position -
// -----------------------------------------------------------------------------

/// Positions in a local space.
/// These coordiantes can not be negative.
/// `0, 0` refers to top left.
#[derive(Debug, Clone, Copy, PartialEq, Eq, Hash, Default)]
pub struct LocalPos {
    /// X coordinate
    pub x: u16,
    /// Y coordinate
    pub y: u16,
}

impl LocalPos {
    /// Zero...
    pub const ZERO: Self = Self::new(0, 0);

    /// Create a new set of coordinates in local space
    pub const fn new(x: u16, y: u16) -> Self {
        Self { x, y }
    }

    pub const fn to_index(self, width: u16) -> usize {
        (self.y * width + self.x) as usize
    }

    pub const fn saturating_sub(mut self, other: Self) -> Self {
        self.x = self.x.saturating_sub(other.x);
        self.y = self.y.saturating_sub(other.y);
        self
    }
}

impl From<(u16, u16)> for LocalPos {
    fn from((x, y): (u16, u16)) -> Self {
        Self { x, y }
    }
}

impl From<(i32, i32)> for LocalPos {
    fn from((x, y): (i32, i32)) -> Self {
        Self {
            x: x as u16,
            y: y as u16,
        }
    }
}

impl From<(usize, usize)> for LocalPos {
    fn from((x, y): (usize, usize)) -> Self {
        Self {
            x: x as u16,
            y: y as u16,
        }
    }
}

impl TryFrom<Pos> for LocalPos {
    type Error = ();

    fn try_from(value: Pos) -> Result<Self, Self::Error> {
        if value.x < 0 || value.y < 0 {
            return Err(());
        }

        if value.x > u16::MAX as i32 || value.y > u16::MAX as i32 {
            return Err(());
        }

        Ok(Self {
            x: value.x as u16,
            y: value.y as u16,
        })
    }
}

impl Add for LocalPos {
    type Output = Self;

    fn add(self, rhs: Self) -> Self::Output {
        LocalPos {
            x: self.x + rhs.x,
            y: self.y + rhs.y,
        }
    }
}

impl AddAssign for LocalPos {
    fn add_assign(&mut self, rhs: Self) {
        self.x += rhs.x;
        self.y += rhs.y;
    }
}

#[cfg(test)]
mod test {
    use super::*;

    #[test]
    fn index_from_coords() {
        let width = 20;

        let actual = LocalPos::new(0, 0).to_index(width);
        let expected = 0;
        assert_eq!(expected, actual);

        let actual = LocalPos::new(10, 0).to_index(width);
        let expected = 10;
        assert_eq!(expected, actual);

        let actual = LocalPos::new(4, 20).to_index(width);
        let expected = (width * width) as usize + 4;
        assert_eq!(expected, actual);
    }
}