Should this function (and the next) be here? Not in the OMPLInterface class? It seems they should be in the interface class, and only expose them here. Thoughts?