Function kalman_rs::traits::organize_points

pub fn organize_points<'a>(
    input_points: &'a mut [Point3<f32>; 4]
) -> &'a [Point3<f32>; 4]

This function organizes the input points of a sensor into a known order so that quadralateral_contains will correctly function. There is a known edge in which a trapezoid with an extremely low height will choose the wrong order of points. This is relatively easy to fix but quadruples the total number of comparissons needed.