use core::{iter::Map, slice::Iter};
use num_traits::{Num, NumCast, Zero};
use rstar::{AABB, Envelope, RTreeNum, primitives::Rectangle};
pub trait Rings<K> {
type RingIter<'a>: Iterator<Item = &'a [[K; 2]]>
where
Self: 'a,
K: 'a;
fn exterior(&self) -> &[[K; 2]];
fn interiors<'a>(&'a self) -> Self::RingIter<'a>;
}
pub(crate) fn rectangle_from_polygon<K: RTreeNum, P: Rings<K>>(polygon: &P) -> Rectangle<[K; 2]> {
Rectangle::from_aabb(
polygon
.exterior()
.iter()
.fold(AABB::new_empty(), |aabb, vertex| {
aabb.merged(&AABB::from_point([vertex[0], vertex[1]]))
}),
)
}
#[derive(Clone, Copy, Debug, Eq, Ord, PartialEq, PartialOrd)]
pub struct PolygonId(usize);
impl PolygonId {
#[inline]
pub fn new(id: usize) -> Self {
Self(id)
}
#[inline]
pub fn index(self) -> usize {
self.0
}
}
#[derive(Clone, Debug)]
pub struct Polygon<K> {
pub exterior: Vec<[K; 2]>,
pub interiors: Vec<Vec<[K; 2]>>,
}
impl<K> Rings<K> for Polygon<K> {
type RingIter<'a>
= Map<Iter<'a, Vec<[K; 2]>>, fn(&'a Vec<[K; 2]>) -> &'a [[K; 2]]>
where
K: 'a;
fn exterior(&self) -> &[[K; 2]] {
self.exterior.as_slice()
}
fn interiors<'a>(&'a self) -> Self::RingIter<'a> {
self.interiors.iter().map(Vec::as_slice)
}
}
pub trait Centroid<K> {
fn centroid(&self) -> [K; 2];
}
fn polygon_centroid<K>(vertices: impl IntoIterator<Item = [K; 2]>) -> [K; 2]
where
K: Copy + Num + NumCast + Zero,
{
let mut sum = [K::zero(), K::zero()];
let mut len = 0usize;
for [x, y] in vertices {
sum[0] = sum[0] + x;
sum[1] = sum[1] + y;
len += 1;
}
if len == 0 {
return [K::zero(), K::zero()];
}
let n = NumCast::from(len).expect("vertex count fits in coordinate type");
[sum[0] / n, sum[1] / n]
}
impl<K> Centroid<K> for Polygon<K>
where
K: Copy + Num + NumCast + Zero,
{
fn centroid(&self) -> [K; 2] {
polygon_centroid(self.exterior.iter().copied())
}
}
#[derive(Clone, Debug)]
pub struct PolygonWithData<K, W = ()> {
pub exterior: Vec<[K; 2]>,
pub interiors: Vec<Vec<[K; 2]>>,
pub data: W,
}
impl<K, W> Rings<K> for PolygonWithData<K, W> {
type RingIter<'a>
= Map<Iter<'a, Vec<[K; 2]>>, fn(&'a Vec<[K; 2]>) -> &'a [[K; 2]]>
where
K: 'a,
W: 'a;
fn exterior(&self) -> &[[K; 2]] {
self.exterior.as_slice()
}
fn interiors<'a>(&'a self) -> Self::RingIter<'a> {
self.interiors.iter().map(Vec::as_slice)
}
}
impl<K, W> Centroid<K> for PolygonWithData<K, W>
where
K: Copy + Num + NumCast + Zero,
{
fn centroid(&self) -> [K; 2] {
polygon_centroid(self.exterior.iter().copied())
}
}
#[cfg(test)]
mod tests {
use super::*;
#[test]
fn polygon_centroid_of_triangle() {
let polygon = Polygon {
exterior: vec![[0, 0], [3, 0], [0, 3]],
interiors: Vec::new(),
};
assert_eq!(Centroid::centroid(&polygon), [1, 1]);
}
#[test]
fn polygon_centroid_of_empty_polygon() {
let polygon = Polygon::<i64> {
exterior: Vec::new(),
interiors: Vec::new(),
};
assert_eq!(Centroid::centroid(&polygon), [0, 0]);
}
#[test]
fn polygon_with_data_centroid() {
let polygon = PolygonWithData {
exterior: vec![[0, 0], [4, 0], [4, 2], [0, 2]],
interiors: Vec::new(),
data: (),
};
assert_eq!(Centroid::centroid(&polygon), [2, 1]);
}
}