Kostas Bekris at the University of Nevada at Reno has kindly provided two additional planners for use in OOPSMP:
All the new and changed files are available in one zip file. Back up your original OOPSMP distribution first. Then extract the zip file on top of your existing code. Although we plan to incorporate this code in the next release of OOPSMP, this code is currently not officially supported.
Beyond the files for the three planners (DDRRT under RRT, VisPRM under PRM under VisPRM) the other changes include:
If you run VisPRM on the SE2 example you should get results similar to what is described in the presentation. The output roadmap of VisPRM is a very sparse roadmap but the resulting path is quite redundant. It should be taking less than 5 sec for VisPRM to finish.
The implementation of VisPRM is not making use of the state and edge iterators that PRM provides. Moreover, the input parameters for the algorithm are set in the "clear()" function of the algorithm instead of actually using the factory approach.