Skip to main content

calc_obstacle_cost

Function calc_obstacle_cost 

Source
pub fn calc_obstacle_cost(
    trajectory: &[Vector5<f64>],
    ob: &[(f64, f64)],
    config: &Config,
) -> f64