Polished: addPoints, Search Nearest Neighbor