findNearestPosition()

public static Vector3f findNearestPosition(Vector3f reference, Collection<Vector3f> positions){
    Vector3f nearestPos = null;
    float nearestDist = Float.MAX_VALUE;


    for(Vector3f v : positions){
        //DistanceSquared reicht, so können wir Wurzelziehen (teuer) verhinden
        float distSqr = v.distanceSquared(reference);
        if(distSqr < nearestDist){
            nearestPos = v;
            nearestDist = distSqr;
        }
    }
    return nearestPos;
}