Function in_cone 

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