use crate::common::Interval;
use crate::geom2::UnitVec2;
use crate::metrology::{SurfaceDeviation2, SurfaceDeviationSet2};
use crate::{Curve2, CurveStation2, IntervalOps, Point2, SurfacePoint2};
pub fn point_curve2_deviation(station: &CurveStation2, point: &Point2) -> SurfaceDeviation2 {
let sp = station.surface_point();
let vector = point - station.point();
let normal = if vector.norm() < 1e-6 {
sp.normal
} else if vector.dot(&sp.normal) < 0.0 {
UnitVec2::new_normalize(-vector)
} else {
UnitVec2::new_normalize(vector)
};
SurfaceDeviation2::new(
SurfacePoint2::new(station.point(), normal),
vector.dot(&normal),
)
}
pub fn line_surface_deviations(
nominal: &Curve2,
actual: &[Point2],
interval: Option<Interval>,
) -> SurfaceDeviationSet2 {
let mut result = SurfaceDeviationSet2::default();
for p in actual {
let closest = nominal.at_closest_to_point(p);
if let Some(i) = interval
&& !i.contains_value(closest.length_along())
{
continue;
}
result.push(point_curve2_deviation(&closest, p));
}
result
}