Function point_in_cone 

fn point_in_cone(
    point: Position2,
    apex: Position2,
    heading: f64,
    half_angle: f64,
    range: f64,
) -> bool