[GeoLib] More robust OctTree::addPoint(), more tests for existing OctTree::rangeQuery()

Changes make OctTree::addPoint() more robust thus the range for the range query is adjusted.

1. Feature description was added to the changelog
2. Tests covering your feature were added?
3. Any new feature or behaviour change was documented? - behaviour wasn't changed