mirror of https://codeberg.org/topola/topola.git
feat(math): add cached variant of polygonal tangent calculation
This commit is contained in:
parent
7799c50829
commit
46d3d0e4a0
|
|
@ -199,7 +199,10 @@ pub fn intersect_circle_segment(circle: &Circle, segment: &Line) -> Vec<Point> {
|
||||||
/// `from` and `to`.
|
/// `from` and `to`.
|
||||||
pub fn between_vectors(p: Point, from: Point, to: Point) -> bool {
|
pub fn between_vectors(p: Point, from: Point, to: Point) -> bool {
|
||||||
let cross = perp_dot_product(from, to);
|
let cross = perp_dot_product(from, to);
|
||||||
|
between_vectors_cached(p, from, to, cross)
|
||||||
|
}
|
||||||
|
|
||||||
|
fn between_vectors_cached(p: Point, from: Point, to: Point, cross: f64) -> bool {
|
||||||
if cross > 0.0 {
|
if cross > 0.0 {
|
||||||
perp_dot_product(from, p) >= 0.0 && perp_dot_product(p, to) >= 0.0
|
perp_dot_product(from, p) >= 0.0 && perp_dot_product(p, to) >= 0.0
|
||||||
} else if cross < 0.0 {
|
} else if cross < 0.0 {
|
||||||
|
|
|
||||||
|
|
@ -2,7 +2,9 @@
|
||||||
//
|
//
|
||||||
// SPDX-License-Identifier: MIT
|
// SPDX-License-Identifier: MIT
|
||||||
|
|
||||||
use super::{between_vectors, cyclic_breadth_partition_search};
|
use super::{
|
||||||
|
between_vectors, between_vectors_cached, cyclic_breadth_partition_search, perp_dot_product,
|
||||||
|
};
|
||||||
use geo::Point;
|
use geo::Point;
|
||||||
|
|
||||||
#[derive(Clone, Debug, thiserror::Error, PartialEq)]
|
#[derive(Clone, Debug, thiserror::Error, PartialEq)]
|
||||||
|
|
@ -17,6 +19,79 @@ pub enum PolyTangentException<I> {
|
||||||
},
|
},
|
||||||
}
|
}
|
||||||
|
|
||||||
|
/// Caches the `perp_dot_product` call in [`between_vectors`]
|
||||||
|
pub struct CachedPolyExt<I>(pub Box<[(Point, I, f64)]>, bool);
|
||||||
|
|
||||||
|
impl<I: Copy + Eq> CachedPolyExt<I> {
|
||||||
|
pub fn new(poly_ext: &[(Point, I)], poly_ext_is_cw: bool) -> Self {
|
||||||
|
assert!(!poly_ext.is_empty());
|
||||||
|
Self(
|
||||||
|
poly_ext
|
||||||
|
.iter()
|
||||||
|
.enumerate()
|
||||||
|
.map(|(i, &(cur, index))| {
|
||||||
|
let prev = poly_ext[(poly_ext.len() + i - 1) % poly_ext.len()].0;
|
||||||
|
let next = poly_ext[(i + 1) % poly_ext.len()].0;
|
||||||
|
let cross = perp_dot_product(cur - prev, cur - next);
|
||||||
|
(cur, index, cross)
|
||||||
|
})
|
||||||
|
.collect(),
|
||||||
|
poly_ext_is_cw,
|
||||||
|
)
|
||||||
|
}
|
||||||
|
|
||||||
|
/// Calculates the tangents to the polygon exterior going through point `origin`.
|
||||||
|
pub fn tangent_points(&self, origin: Point) -> Option<(I, I)> {
|
||||||
|
let poly_ext = &self.0;
|
||||||
|
debug_assert!(!poly_ext.is_empty());
|
||||||
|
|
||||||
|
let (pos_false, pos_true) =
|
||||||
|
cyclic_breadth_partition_search(0..poly_ext.len(), &|i: usize| {
|
||||||
|
let prev = &poly_ext[(poly_ext.len() + i - 1) % poly_ext.len()];
|
||||||
|
let cur = &poly_ext[i];
|
||||||
|
let next = &poly_ext[(i + 1) % poly_ext.len()];
|
||||||
|
|
||||||
|
// local coordinate system with origin at `cur.0`.
|
||||||
|
between_vectors_cached(cur.0 - origin, cur.0 - prev.0, cur.0 - next.0, cur.2)
|
||||||
|
});
|
||||||
|
|
||||||
|
let (mut pos_false, mut pos_true) =
|
||||||
|
if let (Some(pos_false), Some(pos_true)) = (pos_false, pos_true) {
|
||||||
|
(pos_false, pos_true)
|
||||||
|
} else {
|
||||||
|
return None;
|
||||||
|
};
|
||||||
|
|
||||||
|
// * `pos_false` points to the maximum
|
||||||
|
// * `pos_true` points to the minimum
|
||||||
|
|
||||||
|
// NOTE: although pos_{false,true} are vertex indices, they are actually
|
||||||
|
// referring to the "critical" segment(s) (pos_false, pos_false + 1) (and resp. for pos_true).
|
||||||
|
// because that is where the `between_vectors` result flips.
|
||||||
|
// These critical segments are independent of CW/CCW.
|
||||||
|
|
||||||
|
// if `poly_ext` is oriented CCW, then
|
||||||
|
// * `pos_false` will be one too early, and
|
||||||
|
// * `pos_true` will be correct.
|
||||||
|
|
||||||
|
// if `poly_ext` is oriented CW, then
|
||||||
|
// * `pos_false` will be correct.
|
||||||
|
// * `pos_true` will be one too early, and
|
||||||
|
|
||||||
|
// TODO: can we (without too much overhead) determine if `poly_ext` is CW or CCW?
|
||||||
|
|
||||||
|
if self.1 {
|
||||||
|
pos_true += 1;
|
||||||
|
pos_true %= poly_ext.len();
|
||||||
|
} else {
|
||||||
|
pos_false += 1;
|
||||||
|
pos_false %= poly_ext.len();
|
||||||
|
}
|
||||||
|
|
||||||
|
Some((poly_ext[pos_true].1, poly_ext[pos_false].1))
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
/// Calculates the tangents to the polygon exterior `poly_ext` oriented `cw?=poly_ext_is_cw`
|
/// Calculates the tangents to the polygon exterior `poly_ext` oriented `cw?=poly_ext_is_cw`
|
||||||
/// going through point `origin`.
|
/// going through point `origin`.
|
||||||
pub fn poly_ext_tangent_points<I: Copy>(
|
pub fn poly_ext_tangent_points<I: Copy>(
|
||||||
|
|
|
||||||
Loading…
Reference in New Issue