pub fn pure_pursuit(
sensors: &SensorData,
path: &Vec<Point2<i8>, MAX_ROBOT_PATH_LENGTH>,
lookahead: f32,
speed: f32,
snapping_dist: f32,
snapping_multiplier: f32,
cv_location: Option<Point2<i8>>,
) -> Option<Vector2<f32>>