1 / 52

Sampling-Based Planners

Sampling-Based Planners. The complexity of the robot’s free space is overwhelming. T he cost of computing an exact representation of the configuration space of a free-flying 3D object, or a multi-joint articulated object is often prohibitive

scott
Download Presentation

Sampling-Based Planners

An Image/Link below is provided (as is) to download presentation Download Policy: Content on the Website is provided to you AS IS for your information and personal use and may not be sold / licensed / shared on other websites without getting consent from its author. Content is provided to you AS IS for your information and personal use only. Download presentation by click this link. While downloading, if for some reason you are not able to download a presentation, the publisher may have deleted the file from their server. During download, if you can't get a presentation, the file might be deleted by the publisher.

E N D

Presentation Transcript


  1. Sampling-Based Planners

  2. The complexity of the robot’s free space is overwhelming

  3. The cost of computing an exact representation of the configuration space of a free-flying 3D object, or a multi-joint articulated object is often prohibitive • But very fast algorithms exist that can check if a rigid or articulated object at a given configuration collides with obstacles •  Basic idea of Probabilistic Roadmaps (PRMs): Compute a very simplified representation of the free space by sampling configurations at random

  4. Initial idea: Potential Field + Random Walk • Attract some points toward their goal • Repulse other points by obstacles • Use collision check to test collision • Escape local minima by performing random walks

  5. But many pathological cases …

  6. Illustration of a Bad Potential “Landscape” U q Global minimum

  7. forbidden space Free/feasible space Probabilistic Roadmap (PRM) Space n

  8. Probabilistic Roadmap (PRM) Configurations are sampled by picking coordinates at random

  9. Probabilistic Roadmap (PRM) Configurations are sampled by picking coordinates at random

  10. Probabilistic Roadmap (PRM) Sampled configurations are tested for collision

  11. Probabilistic Roadmap (PRM) The collision-free configurations are retained as milestones

  12. Probabilistic Roadmap (PRM) Each milestone is linked by straight paths to its nearest neighbors

  13. Probabilistic Roadmap (PRM) Each milestone is linked by straight paths to its nearest neighbors

  14. Probabilistic Roadmap (PRM) The collision-free links are retained as local paths to form the PRM

  15. g s Probabilistic Roadmap (PRM) The start and goal configurations are included as milestones

  16. g s Probabilistic Roadmap (PRM) The PRM is searched for a path from s to g

  17. Multi- vs. Single-Query PRMs • Multi-query roadmaps Pre-compute roadmap Re-use roadmap for answering queries • Single-query roadmaps Compute a roadmap from scratch for each new query

  18. Sampling strategy This answer may occasionally be incorrect Procedure BasicPRM(s,g,N) • Initialize the roadmap R with two nodes, s and g • Repeat: • Sample a configuration q from C with probability measure p • If q  F then add q as a new node of R • For some nodes v in R such that v q do If path(q,v)  Fthen add (q,v) as a new edge of R Until s and g are in the same connected component of R or R contains N+2 nodes • If s and g are in the same connected component of R then Return a path between them • Else Return NoPath

  19. Requirements of PRM Planning • Checking sampled configurations and connections between samples for collision can be done efficiently.  Hierarchical collision detection • A relatively small number of milestones and local paths are sufficient to capture the connectivity of the free space.  Non-uniform sampling strategies

  20. RRT: Another popular variant • Rapidly-exploring random trees qrand q’ qnear

  21. RRT: Another popular variant • Rapidly-exploring random trees qrand q’ qnear

  22. RRT: Another popular variant • Rapidly-exploring random trees qrand qnear

  23. RRT: Another popular variant • Rapidly-exploring random trees qrand qnear

  24. RRT: Another popular variant • Rapidly-exploring random trees qrand qnear

  25. RRT: Another popular variant • Rapidly-exploring random trees qrand qnear

  26. RRT: Another popular variant • Rapidly-exploring random trees qrand qnear

  27. RRT: Another popular variant • Rapidly-exploring random trees

  28. PRM planners work well in practice. Why?

  29. PRM planners work well in practice. Why? • Why are they probabilistic? • What does their success tell us? • How important is the probabilistic sampling measure p?

  30. A PRM planner ignores the exact shape of F. So, it acts like a robot building a map of an unknown environment with limited sensors At any moment, there existsan implicit distribution (H,s), where H is the set of all consistent hypotheses over the shapes of F For every x  H, s(x) is the probability that x is correct The probabilistic sampling measure p reflects this uncertainty. [Its goal is to minimize the expected number of remaining iterations to connect s and g, whenever they lie in the same component of F.] Why is PRM planning probabilistic?

  31. PRM planning trades the cost of computing F exactly against the cost of dealing with uncertainty This choice is beneficial only if a small roadmap has high probability to represent F well enough to answer planning queries correctly Under which conditions is this the case? So ...

  32. f(x) A = a × b b (xi,yi) a x Relation to Monte Carlo Integration x1 x2

  33. f(x) A = a × b b (xi,yi) a x Relation to Monte Carlo Integration But a PRM planner must construct a path The connectivity of F may depend on small regions Insufficient sampling of such regions may lead the planner to failure x1 x2

  34. Visibility in F • Two configurations q and q’ see each other ifpath(q,q’)  F • The visibility set of q is V(q) = {q’ | path(q,q’)  F}

  35. F V(q) q Here, ε ≈ 0.18 ε-Goodness of F • Let μ(X) stand for the volume of X  F • Given ε (0,1], q  F is ε-good if it sees at least an ε-fraction of F, i.e., if μ(V(q)) εμ(F) • F is ε-good if every q in F is ε-good • Intuition: If F is ε-good, then with high probability a small set of configurations sampled at random will see most of F

  36. F1 F2 Connectivity Issue

  37. F1 F2 Lookout of F1 Connectivity Issue

  38. F1 F2 Lookout of F1 Connectivity Issue The β-lookout of a subset F1 of F is the set of all configurations in F1 that see a β-fraction of F2 = F\ F1 β-lookout(F1) = {q  F1 | μ(V(q)F2)  βμ(F2)}

  39. F1 F2 Lookout of F1 Connectivity Issue The β-lookout of a subset F1 of F is the set of all configurations in F1 that see a β-fraction of F2 = F\ F1 β-lookout(F1) = {q  F1 | μ(V(q)F2)  βμ(F2)} F is(ε,α,β)-expansiveif it is ε-good and each one of its subsets X has a β-lookout whose volume is at least αμ(X) Intuition: If F is favorably expansive, it should be relatively easy to capture its connectivity by a small network of sampled configurations

  40. Comments • Expansiveness only depends on volumetric ratios • It is not directly related to the dimensionality of the configuration space E.g., in 2-D the expansiveness of the free space can be made arbitrarily poor

  41. Thanks to the wide passage at the bottom this space is favorably expansive Many narrow passages might be better than a single one This space’s expansiveness is worsethan if the passage was straight A convex set is maximally expansive,i.e., ε = α = β = 1

  42. Experimental convergence g= Pr(Failure)  Theoretical Convergence of PRM Planning Theorem 1 Let F be (ε,α,β)-expansive, and s and g be two configurations in the same component of F. BasicPRM(s,g,N) with uniform sampling returns a path between s and g with probability converging to 1 at an exponential rate as N increases

  43. Theoretical Convergence of PRM Planning Theorem 1 Let F be (ε,α,β)-expansive, and s and g be two configurations in the same component of F. BasicPRM(s,g,N) with uniform sampling returns a path between s and g with probability converging to 1 at an exponential rate as N increases Theorem 2 For any ε > 0, any N > 0, and any g in (0,1], there exists αo and βo such that if F is not (ε,α,β)-expansive for α > α0 and β > β0, then there exists s and g in the same component of F such that BasicPRM(s,g,N) fails to return a path with probability greater than g.

  44. What does the empirical success of PRM planning tell us? It tells us that F is often favorably expansive despite its overwhelming algebraic and geometric complexity

  45. Not really! Narrow passages are unstable features under small random perturbations of the robot/workspace geometry  Poorly expansive space are unlikely to occur by accident In retrospect, is this property surprising?

  46. PRM planners work well in practice. Why? • Why are they probabilistic? • What does their success tell us? • How important is the probabilistic sampling measure π?

  47. good visibility poor visibility How important is the probability sampling measure π? • Visibility is usually not uniformly favorable across F • Regions with poorer visibility should be sampled more densely(more connectivity information can be gained there) small lookout sets small visibility sets

  48. g s Impact Gaussian [Boor, Overmars, van der Stappen, 1999] Connectivity expansion [Kavraki, 1994]

  49. But how to identify poor visibility regions? • What is the source of information? • Robot and workspace geometry • How to exploit it? • Workspace-guided strategies • Filtering strategies • Adaptive strategies • Deformation strategies

  50. Conclusion • The success of PRM planning depends mainly and critically on favorable visibility in F • The probability measure used for sampling F derives from the uncertainty on the shape of F • By exploiting the fact that visibility is not uniformly favorable across F, sampling measures have major impact on the efficiency of PRM planning

More Related