pub fn cost_v2_with_history<T: MyFloat>( initial: PhysicsStateV3<T>, curve: &Spline<T>, step: Fpt, min_dist_between_points: Option<Fpt>, ) -> (Option<Fpt>, Vec<CostHistoryPoint>)