ompl
ompl copied to clipboard
WIP: Add multi-goal planning to LazyPRM/LazyPRM*
Fixes #776. Before, LazyPRM would simply use the first sampled goal. This should enable LazyPRM to plan to multiple goals.
Thanks for the review - just tested locally to double check and the LazyPRM is now throwing an exception in some cases, I'll change this to a WIP and request review when I've kicked the tires a bit more.