added simple ompl benchmarking code

Basic support for OMPL benchmarking. How should I pass all the parameters in? Should I do an XML thing like there is elsewhere?