use super::curve::Curve;
use super::interpolations::catmull_rom;
use crate::math::Vector2;
#[derive(Clone, Debug, Default, PartialEq)]
pub struct SplineCurve {
pub points: Vec<Vector2>,
}
impl SplineCurve {
pub fn new(points: Vec<Vector2>) -> Self {
Self { points }
}
}
impl Curve for SplineCurve {
type Point = Vector2;
fn type_name(&self) -> &'static str {
"SplineCurve"
}
fn curve_path_resolution(&self, divisions: usize) -> usize {
divisions * self.points.len()
}
fn get_point(&self, t: f64) -> Vector2 {
let points = &self.points;
let l = points.len() as f64;
let p = (l - 1.0) * t;
let int_point = p.floor();
let weight = p - int_point;
let i = int_point as usize;
let last = points.len() - 1;
let p0 = &points[if int_point == 0.0 { i } else { i - 1 }];
let p1 = &points[i];
let p2 = &points[if int_point > l - 2.0 { last } else { i + 1 }];
let p3 = &points[if int_point > l - 3.0 { last } else { i + 2 }];
Vector2::new(
catmull_rom(weight, p0.x, p1.x, p2.x, p3.x),
catmull_rom(weight, p0.y, p1.y, p2.y, p3.y),
)
}
}