Make method const
Add a benthin and wachter kdtree subclasses
Add a benthin and wachter kdtree subclasses