fn calculate_speed( path: &Vec<Point2<f32>, LOCAL_MAX_PATH_LENGTH>, base_speed: f32, loc: &Point2<f32>, turn_multiplier: f32, ) -> f32