curvo 0.1.88

NURBS modeling library
Documentation
use geo::{BoundingRect, LineIntersection};
use itertools::Itertools;
use nalgebra::Point2;
use num_traits::NumCast;

use crate::misc::FloatingPoint;

/// Convert a points into geo::LineString
pub fn to_line_string_helper<T: FloatingPoint>(points: &[Point2<T>]) -> geo::LineString {
    geo::LineString::new(
        points
            .iter()
            .map(|p| {
                geo::Coord::from([
                    <f64 as NumCast>::from(p.x).unwrap(),
                    <f64 as NumCast>::from(p.y).unwrap(),
                ])
            })
            .collect_vec(),
    )
}

/// Intersection of two line strings
#[derive(Debug, Clone, PartialEq)]
pub struct LineStringIntersection {
    point: Point2<f64>,
    line_index: (usize, usize),
    /// If the intersection is proper, it means that the intersection point is not on the endpoint of the line.
    is_proper: bool,
}

impl LineStringIntersection {
    pub fn point(&self) -> Point2<f64> {
        self.point
    }

    pub fn line_index(&self) -> (usize, usize) {
        self.line_index
    }

    #[allow(unused)]
    pub fn is_proper(&self) -> bool {
        self.is_proper
    }
}

/// Find the intersection of two line strings
pub fn find_line_string_intersection(
    l0: &geo::LineString,
    l1: &geo::LineString,
) -> anyhow::Result<Vec<LineStringIntersection>> {
    let b0 = l0
        .bounding_rect()
        .ok_or(anyhow::anyhow!("no bounding rect for line: {:?}", l0))?;
    let b1 = l1
        .bounding_rect()
        .ok_or(anyhow::anyhow!("no bounding rect for line: {:?}", l1))?;
    if !geo::Intersects::intersects(&b0, &b1) {
        return Ok(vec![]);
    }

    let mut res = vec![];
    l0.lines().enumerate().for_each(|(i0, l0)| {
        l1.lines().enumerate().for_each(|(i1, l1)| {
            let it = geo::algorithm::line_intersection::line_intersection(l0, l1);
            if let Some(LineIntersection::SinglePoint {
                intersection,
                is_proper,
            }) = it
            {
                let pt = Point2::new(intersection.x, intersection.y);
                res.push(LineStringIntersection {
                    point: pt,
                    line_index: (i0, i1),
                    is_proper,
                });
            }
        });
    });

    Ok(res)
}