A rough 2D KDTree implementation in C#