Test and minor refactor findCloseNodes.

* Tests ported from the drogulus project.