use crate::common::angle_in_direction;
use crate::common::points::linear_interpolation_error;
use crate::geom2::polyline2::SpanningRay;
use crate::geom2::{UnitVec2, rot90};
use crate::{AngleDir, Arc2, Circle2, Point2, SurfacePoint2};
use serde::{Deserialize, Serialize};
#[derive(Serialize, Deserialize, Clone)]
pub struct InscribedCircle {
pub spanning_ray: SpanningRay,
pub contact_pos: Point2,
pub contact_neg: Point2,
pub circle: Circle2,
}
impl InscribedCircle {
pub fn new(
spanning_ray: SpanningRay,
contact_pos: Point2,
contact_neg: Point2,
circle: Circle2,
) -> InscribedCircle {
InscribedCircle {
spanning_ray,
contact_pos,
contact_neg,
circle,
}
}
pub fn reversed(&self) -> InscribedCircle {
InscribedCircle::new(
self.spanning_ray.reversed(),
self.contact_neg,
self.contact_pos,
self.circle,
)
}
pub fn contact_arc(&self, direction: &UnitVec2) -> Arc2 {
let angle_u = self.circle.angle_of_point(&self.contact_pos);
let angle_l = self.circle.angle_of_point(&self.contact_neg);
let arc0 = self
.circle
.to_partial_arc(angle_u, angle_in_direction(angle_u, angle_l, AngleDir::Ccw));
let arc1 = self
.circle
.to_partial_arc(angle_l, angle_in_direction(angle_l, angle_u, AngleDir::Ccw));
let v0 = arc0.point_at_fraction(0.5) - self.circle.center;
let v1 = arc1.point_at_fraction(0.5) - self.circle.center;
if direction.dot(&v0) > direction.dot(&v1) {
arc0
} else {
arc1
}
}
pub fn radius(&self) -> f64 {
self.circle.r()
}
pub fn center(&self) -> Point2 {
self.circle.center
}
pub fn camber_point(&self) -> SurfacePoint2 {
let dir = rot90(AngleDir::Cw) * (self.contact_pos - self.contact_neg);
SurfacePoint2::new_normalize(self.center(), dir)
}
pub fn interpolation_error(&self, s0: &Self, s1: &Self) -> f64 {
let upper = linear_interpolation_error(&s0.contact_pos, &s1.contact_pos, &self.contact_pos);
let lower = linear_interpolation_error(&s0.contact_neg, &s1.contact_neg, &self.contact_neg);
let center = linear_interpolation_error(&s0.center(), &s1.center(), &self.center());
upper.max(lower).max(center)
}
pub fn reverse_in_place(&mut self) {
self.spanning_ray = self.spanning_ray.reversed();
std::mem::swap(&mut self.contact_pos, &mut self.contact_neg);
}
}