Intersect functions + tests added

De functie "getnearestpoint" kan gebruikt worden om na te gaan welke van de twee intersect-punten het dichtst bij het midden van de zwerm liggen.