Added BalancingKDTree, added more methods to geometric objects