CHOMP, adapt to OMPL detailed solve() to unify benchmark results
SBPL, change names, auto-select algorithm when the motion request doesn't specify the planner_id, adapt to OMPL style for detailed solve()