Find nearest point now works, but could be faster with more pruning.