use fpnum::{fp, integral_sqrt, FPNum, FPPoint};

use std::{

    cmp::{max, min},

    ops::{Add, AddAssign, Div, DivAssign, Mul, MulAssign, RangeInclusive, Sub, SubAssign},

};

#[derive(PartialEq, Eq, Clone, Copy, Debug)]

pub struct Point {

    pub x: i32,

    pub y: i32,

}

impl Point {

    pub const ZERO: Self = Self::new(0, 0);

    #[inline]

    pub const fn new(x: i32, y: i32) -> Self {

        Self { x, y }

    }

    #[inline]

    pub const fn diag(v: i32) -> Self {

        Self::new(v, v)

    }

    #[inline]

    pub fn signum(self) -> Self {

        Self::new(self.x.signum(), self.y.signum())

    }

    #[inline]

    pub fn abs(self) -> Self {

        Self::new(self.x.abs(), self.y.abs())

    }

    #[inline]

    pub const fn dot(self, other: Point) -> i32 {

        self.x * other.x + self.y * other.y

    }

    #[inline]

    pub fn max_norm(self) -> i32 {

        std::cmp::max(self.x.abs(), self.y.abs())

    }

    #[inline]

    pub fn integral_norm(self) -> u32 {

        let sqr = (self.x as u64).pow(2) + (self.y as u64).pow(2);

        integral_sqrt(sqr) as u32

    }

    #[inline]

    pub const fn transform(self, matrix: &[i32; 4]) -> Self {

        Point::new(

            matrix[0] * self.x + matrix[1] * self.y,

            matrix[2] * self.x + matrix[3] * self.y,

        )

    }

    #[inline]

    pub const fn rotate90(self) -> Self {

        Point::new(self.y, -self.x)

    }

    #[inline]

    pub const fn cross(self, other: Point) -> i32 {

        self.dot(other.rotate90())

    }

    #[inline]

    pub fn clamp(self, rect: &Rect) -> Point {

        Point::new(rect.x_range().clamp(self.x), rect.y_range().clamp(self.y))

    }

    #[inline]

    pub const fn line_to(self, end: Point) -> Line {

        Line::new(self, end)

    }

    #[inline]

    pub const fn ray_with_dir(self, direction: Point) -> Ray {

        Ray::new(self, direction)

    }

    #[inline]

    pub const fn tangent_mul(self, x: i32) -> i32 {

        x * self.y / self.x

    }

    #[inline]

    pub const fn cotangent_mul(self, y: i32) -> i32 {

        y * self.x / self.y

    }

    #[inline]

    pub fn to_fppoint(self) -> FPPoint {

        FPPoint::new(self.x.into(), self.y.into())

    }

    #[inline]

    pub fn from_fppoint(p: &FPPoint) -> Self {

        Self::new(p.x().round(), p.y().round())

    }

}

#[derive(PartialEq, Eq, Clone, Copy, Debug)]

pub struct Size {

    pub width: usize,

    pub height: usize,

}

impl Size {

    pub const EMPTY: Self = Self::square(0);

    #[inline]

    pub const fn new(width: usize, height: usize) -> Self {

        Self { width, height }

    }

    #[inline]

    pub const fn square(size: usize) -> Self {

        Self {

            width: size,

            height: size,

        }

    }

    #[inline]

    pub const fn area(&self) -> usize {

        self.width * self.height

    }

    #[inline]

    pub const fn linear_index(&self, x: usize, y: usize) -> usize {

        y * self.width + x

    }

    #[inline]

    pub fn is_power_of_two(&self) -> bool {

        self.width.is_power_of_two() && self.height.is_power_of_two()

    }

    #[inline]

    pub fn next_power_of_two(&self) -> Self {

        Self {

            width: self.width.next_power_of_two(),

            height: self.height.next_power_of_two(),

        }

    }

    #[inline]

    pub const fn transpose(&self) -> Self {

        Self::new(self.height, self.width)

    }

    #[inline]

    pub fn to_mask(&self) -> SizeMask {

        SizeMask::new(*self)

    }

    #[inline]

    pub fn to_square(&self) -> Self {

        Self::square(max(self.width, self.height))

    }

    pub fn to_grid_index(&self) -> GridIndex {

        GridIndex::new(*self)

    }

    #[inline]

    pub fn contains(&self, other: Self) -> bool {

        self.width >= other.width && self.height >= other.height

    }

}

#[derive(PartialEq, Eq, Clone, Copy, Debug)]

pub struct SizeMask {

    size: Size,

}

impl SizeMask {

    #[inline]

    pub fn new(size: Size) -> Self {

        debug_assert!(size.is_power_of_two());

        let size = Size {

            width: !(size.width - 1),

            height: !(size.height - 1),

        };

        Self { size }

    }

    #[inline]

    pub fn contains_x<T: Into<usize>>(&self, x: T) -> bool {

        (self.size.width & x.into()) == 0

    }

    #[inline]

    pub fn contains_y<T: Into<usize>>(&self, y: T) -> bool {

        (self.size.height & y.into()) == 0

    }

    #[inline]

    pub fn contains(&self, point: Point) -> bool {

        self.contains_x(point.x as usize) && self.contains_y(point.y as usize)

    }

}

pub struct GridIndex {

    shift: Point,

}

impl GridIndex {

    pub fn new(size: Size) -> Self {

        assert!(size.is_power_of_two());

        let shift = Point::new(

            size.width.trailing_zeros() as i32,

            size.height.trailing_zeros() as i32,

        );

        Self { shift }

    }

    pub fn map(&self, position: Point) -> Point {

        Point::new(position.x >> self.shift.x, position.y >> self.shift.y)

    }

}

macro_rules! bin_op_impl {

    ($op: ty, $name: tt) => {

        impl $op for Point {

            type Output = Self;

            #[inline]

            fn $name(self, rhs: Self) -> Self::Output {

                Self::new(self.x.$name(rhs.x), self.y.$name(rhs.y))

            }

        }

    };

}

macro_rules! scalar_bin_op_impl {

    ($($op: tt)::+, $name: tt) => {

        impl $($op)::+<i32> for Point {

            type Output = Self;

            #[inline]

            fn $name(self, rhs: i32) -> Self::Output {

                Self::new(self.x.$name(rhs), self.y.$name(rhs))

            }

        }

    };

}

macro_rules! bin_assign_op_impl {

    ($op: ty, $name: tt) => {

        impl $op for Point {

            #[inline]

            fn $name(&mut self, rhs: Self) {

                self.x.$name(rhs.x);

                self.y.$name(rhs.y);

            }

        }

    };

}

macro_rules! fp_scalar_bin_op_impl {

    ($($op: tt)::+, $name: tt) => {

        impl $($op)::+<FPNum> for Point {

            type Output = FPPoint;

            #[inline]

            fn $name(self, rhs: FPNum) -> Self::Output {

                FPPoint::new(rhs.$name(self.x), rhs.$name(self.y))

            }

        }

    };

}

macro_rules! left_fp_scalar_bin_op_impl {

    ($($op: tt)::+, $name: tt) => {

        impl $($op)::+<Point> for FPNum {

            type Output = FPPoint;

            #[inline]

            fn $name(self, rhs: Point) -> Self::Output {

                FPPoint::new(self.$name(rhs.x), self.$name(rhs.y))

            }

        }

    };

}

bin_op_impl!(Add, add);

bin_op_impl!(Sub, sub);

bin_op_impl!(Mul, mul);

bin_op_impl!(Div, div);

scalar_bin_op_impl!(Mul, mul);

scalar_bin_op_impl!(Div, div);

fp_scalar_bin_op_impl!(Mul, mul);

fp_scalar_bin_op_impl!(Div, div);

left_fp_scalar_bin_op_impl!(Mul, mul);

left_fp_scalar_bin_op_impl!(Div, div);

bin_assign_op_impl!(AddAssign, add_assign);

bin_assign_op_impl!(SubAssign, sub_assign);

bin_assign_op_impl!(MulAssign, mul_assign);

bin_assign_op_impl!(DivAssign, div_assign);

#[derive(PartialEq, Eq, Clone, Copy, Debug)]

pub struct Rect {

    top_left: Point,

    bottom_right: Point,

}

impl Rect {

    pub const EMPTY: Self = Self {

        top_left: Point::ZERO,

        bottom_right: Point::diag(-1),

    };

    #[inline]

    pub fn new(top_left: Point, bottom_right: Point) -> Self {

        debug_assert!(top_left.x <= bottom_right.x + 1);

        debug_assert!(top_left.y <= bottom_right.y + 1);

        Self {

            top_left,

            bottom_right,

        }

    }

    pub fn from_box(left: i32, right: i32, top: i32, bottom: i32) -> Self {

        Self::new(Point::new(left, top), Point::new(right, bottom))

    }

    pub fn from_size(top_left: Point, size: Size) -> Self {

        Self::new(

            top_left,

            top_left + Point::new(size.width as i32 - 1, size.height as i32 - 1),

        )

    }

    pub fn from_size_coords(x: i32, y: i32, width: usize, height: usize) -> Self {

        Self::from_size(Point::new(x, y), Size::new(width, height))

    }

    pub fn at_origin(size: Size) -> Self {

        Self::from_size(Point::ZERO, size)

    }

    #[inline]

    pub const fn width(&self) -> usize {

        (self.right() - self.left() + 1) as usize

    }

    #[inline]

    pub const fn height(&self) -> usize {

        (self.bottom() - self.top() + 1) as usize

    }

    #[inline]

    pub const fn size(&self) -> Size {

        Size::new(self.width(), self.height())

    }

    #[inline]

    pub const fn area(&self) -> usize {

        self.size().area()

    }

    #[inline]

    pub const fn left(&self) -> i32 {

        self.top_left().x

    }

    #[inline]

    pub const fn top(&self) -> i32 {

        self.top_left().y

    }

    #[inline]

    pub const fn right(&self) -> i32 {

        self.bottom_right().x

    }

    #[inline]

    pub const fn bottom(&self) -> i32 {

        self.bottom_right().y

    }

    #[inline]

    pub const fn top_left(&self) -> Point {

        self.top_left

    }

    #[inline]

    pub const fn bottom_right(&self) -> Point {

        self.bottom_right

    }

    #[inline]

    pub fn center(&self) -> Point {

        (self.top_left() + self.bottom_right()) / 2

    }

    #[inline]

    pub fn with_margin(&self, margin: i32) -> Self {

        let offset = Point::diag(margin);

        Self::new(self.top_left() + offset, self.bottom_right() - offset)

    }

    #[inline]

    pub fn x_range(&self) -> RangeInclusive<i32> {

        self.left()..=self.right()

    }

    #[inline]

    pub fn y_range(&self) -> RangeInclusive<i32> {

        self.top()..=self.bottom()

    }

    #[inline]

    pub fn contains(&self, point: Point) -> bool {

        self.x_range().contains(&point.x) && self.y_range().contains(&point.y)

    }

    #[inline]

    pub fn contains_inside(&self, point: Point) -> bool {

        point.x > self.left()

            && point.x < self.right()

            && point.y > self.top()

            && point.y < self.bottom()

    }

    #[inline]

    pub fn contains_rect(&self, other: &Self) -> bool {

        self.contains(other.top_left()) && self.contains(other.bottom_right())

    }

    #[inline]

    pub fn intersects(&self, other: &Rect) -> bool {

        self.left() <= other.right()

            && self.right() >= other.left()

            && self.top() <= other.bottom()

            && self.bottom() >= other.top()

    }

    #[inline]

    pub fn split_at(&self, point: Point) -> [Rect; 4] {

        assert!(self.contains_inside(point));

        [

            Self::from_box(self.left(), point.x, self.top(), point.y),

            Self::from_box(point.x, self.right(), self.top(), point.y),

            Self::from_box(point.x, self.right(), point.y, self.bottom()),

            Self::from_box(self.left(), point.x, point.y, self.bottom()),

        ]

    }

    #[inline]

    pub fn with_margins(&self, left: i32, right: i32, top: i32, bottom: i32) -> Self {

        Self::from_box(

            self.left() - left,

            self.right() + right,

            self.top() - top,

            self.bottom() + bottom,

        )

    }

    #[inline]

    pub fn quotient(self, x: usize, y: usize) -> Point {

        self.top_left() + Point::new((x % self.width()) as i32, (y % self.height()) as i32)

    }

}

trait RangeClamp<T> {

    fn clamp(&self, value: T) -> T;

}

impl<T: Ord + Copy> RangeClamp<T> for RangeInclusive<T> {

    fn clamp(&self, value: T) -> T {