Sampling Strategies for Probabilistic Roadmaps Random Sampling for capturing the connectivity of the...

64
Sampling Strategies for Probabilistic Roadmaps Random Sampling for capturing the connectivity of the C-space:
  • date post

    21-Dec-2015
  • Category

    Documents

  • view

    225
  • download

    7

Transcript of Sampling Strategies for Probabilistic Roadmaps Random Sampling for capturing the connectivity of the...

Page 1: Sampling Strategies for Probabilistic Roadmaps Random Sampling for capturing the connectivity of the C-space:

Sampling Strategies for Probabilistic Roadmaps

Random Sampling for capturing theconnectivity of the C-space:

Page 2: Sampling Strategies for Probabilistic Roadmaps Random Sampling for capturing the connectivity of the C-space:

Sampling Strategies for Probabilistic Roadmaps

Random Sampling for capturing theconnectivity of the C-space:

Page 3: Sampling Strategies for Probabilistic Roadmaps Random Sampling for capturing the connectivity of the C-space:

Sampling Strategies for Probabilistic Roadmaps

Random Sampling for capturing theconnectivity of the C-space:

Page 4: Sampling Strategies for Probabilistic Roadmaps Random Sampling for capturing the connectivity of the C-space:

Sampling Strategies for Probabilistic Roadmaps

Random Sampling for capturing theconnectivity of the C-space:

Page 5: Sampling Strategies for Probabilistic Roadmaps Random Sampling for capturing the connectivity of the C-space:

Sampling Strategies for Probabilistic Roadmaps

Random Sampling for capturing theconnectivity of the C-space:

Page 6: Sampling Strategies for Probabilistic Roadmaps Random Sampling for capturing the connectivity of the C-space:

How efficient is the sampling strategy?

Page 7: Sampling Strategies for Probabilistic Roadmaps Random Sampling for capturing the connectivity of the C-space:

Are the narrow passages well captured in the roadmap?

Page 8: Sampling Strategies for Probabilistic Roadmaps Random Sampling for capturing the connectivity of the C-space:

Are the narrow passages well captured in the roadmap?

Are you keeping redundant free samples in the roadmap?

Page 9: Sampling Strategies for Probabilistic Roadmaps Random Sampling for capturing the connectivity of the C-space:

3 Papers that address these issues:

Visibility-based Probabilistic roadmaps for Motion planning

- Simeon, Laumond and Nissoux (2000)

The Gaussian Sampling Strategy for PRM’s- Boor, Mark and Stappen (1999)

Motion Planning for a Rigid Body Using Random Networks on the Medial Axis of the Free Space- Wilmart, Amato and Stiller (1999)

Page 10: Sampling Strategies for Probabilistic Roadmaps Random Sampling for capturing the connectivity of the C-space:

3 Papers that address these issues:

Visibility-based Probabilistic roadmaps for Motion planning

- Simeon, Laumond and Nissoux (2000)

The Gaussian Sampling Strategy for PRM’s- Boor, Mark and Stappen (1999)

Motion Planning for a Rigid Body Using Random Networks on the Medial Axis of the Free Space- Wilmart, Amato and Stiller (1999)

Page 11: Sampling Strategies for Probabilistic Roadmaps Random Sampling for capturing the connectivity of the C-space:

3 Papers that address these issues:

Visibility-based Probabilistic roadmaps for Motion planning

- Simeon, Laumond and Nissoux (2000)

The Gaussian Sampling Strategy for PRM’s- Boor, Mark and Stappen (1999)

Motion Planning for a Rigid Body Using Random Networks on the Medial Axis of the Free Space- Wilmart, Amato and Stiller (1999)

Page 12: Sampling Strategies for Probabilistic Roadmaps Random Sampling for capturing the connectivity of the C-space:

3 Papers that address these issues:

Visibility-based Probabilistic roadmapsfor Motion planning

- Simeon, Laumond and Nissoux (2000)

The Gaussian Sampling Strategy for PRM’s- Boor, Mark and Stappen (1999)

Motion Planning for a Rigid Body Using Random Networks on the Medial Axis of the Free Space- Wilmart, Amato and Stiller (1999)

Page 13: Sampling Strategies for Probabilistic Roadmaps Random Sampling for capturing the connectivity of the C-space:

Visibility-based probabilistic roadmaps for motion planning

By Simeon, Laumond and Nissoux in 2000

Classical PRM versus Visibility roadmap

Computes a very compact roadmap.

Page 14: Sampling Strategies for Probabilistic Roadmaps Random Sampling for capturing the connectivity of the C-space:

Visibility domain of a free configuration q:

q

Page 15: Sampling Strategies for Probabilistic Roadmaps Random Sampling for capturing the connectivity of the C-space:

The C-space fully captured by ‘guard’ nodes.

Page 16: Sampling Strategies for Probabilistic Roadmaps Random Sampling for capturing the connectivity of the C-space:

The C-space fully captured by ‘guard’ nodes.

Page 17: Sampling Strategies for Probabilistic Roadmaps Random Sampling for capturing the connectivity of the C-space:

The C-space fully captured by ‘guard’ nodes.

Page 18: Sampling Strategies for Probabilistic Roadmaps Random Sampling for capturing the connectivity of the C-space:

The C-space being captured by ‘guards’ and ‘connection’ nodes.

Page 19: Sampling Strategies for Probabilistic Roadmaps Random Sampling for capturing the connectivity of the C-space:

The C-space being captured by ‘guards’ and ‘connection’ nodes.

Page 20: Sampling Strategies for Probabilistic Roadmaps Random Sampling for capturing the connectivity of the C-space:

The C-space fully captured by ‘guards’ and ‘connection’ nodes.

We do not need any other additional node in the roadmap

Page 21: Sampling Strategies for Probabilistic Roadmaps Random Sampling for capturing the connectivity of the C-space:

Algorithm

Page 22: Sampling Strategies for Probabilistic Roadmaps Random Sampling for capturing the connectivity of the C-space:

Algorithm

Page 23: Sampling Strategies for Probabilistic Roadmaps Random Sampling for capturing the connectivity of the C-space:

Algorithm

Page 24: Sampling Strategies for Probabilistic Roadmaps Random Sampling for capturing the connectivity of the C-space:

Algorithm

Page 25: Sampling Strategies for Probabilistic Roadmaps Random Sampling for capturing the connectivity of the C-space:

Algorithm

Page 26: Sampling Strategies for Probabilistic Roadmaps Random Sampling for capturing the connectivity of the C-space:

Algorithm

Page 27: Sampling Strategies for Probabilistic Roadmaps Random Sampling for capturing the connectivity of the C-space:

Algorithm

Page 28: Sampling Strategies for Probabilistic Roadmaps Random Sampling for capturing the connectivity of the C-space:

Algorithm

Page 29: Sampling Strategies for Probabilistic Roadmaps Random Sampling for capturing the connectivity of the C-space:

Algorithm

Page 30: Sampling Strategies for Probabilistic Roadmaps Random Sampling for capturing the connectivity of the C-space:

Results

6-dof puzzle example

Page 31: Sampling Strategies for Probabilistic Roadmaps Random Sampling for capturing the connectivity of the C-space:

Remarks

Maintains a very compact roadmap to handle.

Page 32: Sampling Strategies for Probabilistic Roadmaps Random Sampling for capturing the connectivity of the C-space:

Remarks

Maintains a very compact roadmap to handle.

But: There is a tradeoff with high cost of processing each

new milestone.

Page 33: Sampling Strategies for Probabilistic Roadmaps Random Sampling for capturing the connectivity of the C-space:

Remarks

Maintains a very compact roadmap to handle.

But: There is a tradeoff with high cost of processing each

new milestone. How many iterations needed to capture the full

connectivity?

Page 34: Sampling Strategies for Probabilistic Roadmaps Random Sampling for capturing the connectivity of the C-space:

Remarks

Maintains a very compact roadmap to handle.

But: There is a tradeoff with high cost of processing each

new milestone. How many iterations needed to capture the full

connectivity? The problem of capturing the narrow passage

effectively is still the same as in the basic PRM.

Page 35: Sampling Strategies for Probabilistic Roadmaps Random Sampling for capturing the connectivity of the C-space:

The Gaussian Sampling Strategy for PRM’s

By Boor, Overmars and Stappen in 1999.The idea is to sample near the boundaries of the C-space obstacles with higher probability.

Page 36: Sampling Strategies for Probabilistic Roadmaps Random Sampling for capturing the connectivity of the C-space:

How to sample near boundaries with higher probability?

Page 37: Sampling Strategies for Probabilistic Roadmaps Random Sampling for capturing the connectivity of the C-space:

How to sample near boundaries with higher probability?Using the notion of blurring using a Gaussian, used in image processing.

Page 38: Sampling Strategies for Probabilistic Roadmaps Random Sampling for capturing the connectivity of the C-space:

How to simulate this effect using PRM’s?

Page 39: Sampling Strategies for Probabilistic Roadmaps Random Sampling for capturing the connectivity of the C-space:

Algorithm

Page 40: Sampling Strategies for Probabilistic Roadmaps Random Sampling for capturing the connectivity of the C-space:

Algorithm

Page 41: Sampling Strategies for Probabilistic Roadmaps Random Sampling for capturing the connectivity of the C-space:

Algorithm

Page 42: Sampling Strategies for Probabilistic Roadmaps Random Sampling for capturing the connectivity of the C-space:

Algorithm

Page 43: Sampling Strategies for Probabilistic Roadmaps Random Sampling for capturing the connectivity of the C-space:

Algorithm

Page 44: Sampling Strategies for Probabilistic Roadmaps Random Sampling for capturing the connectivity of the C-space:

Algorithm

Page 45: Sampling Strategies for Probabilistic Roadmaps Random Sampling for capturing the connectivity of the C-space:

Algorithm

Page 46: Sampling Strategies for Probabilistic Roadmaps Random Sampling for capturing the connectivity of the C-space:
Page 47: Sampling Strategies for Probabilistic Roadmaps Random Sampling for capturing the connectivity of the C-space:

Remarks

Advantage: May lead to discovery of narrow passages

or openings to narrow passages.

Page 48: Sampling Strategies for Probabilistic Roadmaps Random Sampling for capturing the connectivity of the C-space:

Remarks

Advantage: May lead to discovery of narrow passages

or openings to narrow passages.

Disadvantages: The Algorithm dose not distinguish between

open space boundaries and narrow passage boundaries.

Page 49: Sampling Strategies for Probabilistic Roadmaps Random Sampling for capturing the connectivity of the C-space:

Remarks

Advantage: May lead to discovery of narrow passages

or openings to narrow passages.

Disadvantages: The Algorithm dose not distinguish between

open space boundaries and narrow passage boundaries.

If the volume of narrow passage is low then it would be captured with low probabilities.

Page 50: Sampling Strategies for Probabilistic Roadmaps Random Sampling for capturing the connectivity of the C-space:

Remarks

Advantage: May lead to discovery of narrow passages or

openings to narrow passages.

Disadvantages: The Algorithm dose not distinguish between

open space boundaries and narrow passage boundaries.

If the volume of narrow passage is low then it would be captured with low probabilities.

In ‘n’ dimensions it is still like sampling in ‘n-1’ dimensions.

Page 51: Sampling Strategies for Probabilistic Roadmaps Random Sampling for capturing the connectivity of the C-space:

Sampling on the Medial Axis of the Free Space

By Wilmarth, Amato and Stiller in 1999.Motion Planning in 3D space for a rigid body.Medial Axis of the free space is like a Roadmap:

Page 52: Sampling Strategies for Probabilistic Roadmaps Random Sampling for capturing the connectivity of the C-space:

MAPRM

Page 53: Sampling Strategies for Probabilistic Roadmaps Random Sampling for capturing the connectivity of the C-space:

MAPRM

Page 54: Sampling Strategies for Probabilistic Roadmaps Random Sampling for capturing the connectivity of the C-space:

MAPRM

Page 55: Sampling Strategies for Probabilistic Roadmaps Random Sampling for capturing the connectivity of the C-space:

MAPRM

Page 56: Sampling Strategies for Probabilistic Roadmaps Random Sampling for capturing the connectivity of the C-space:

MAPRM

Page 57: Sampling Strategies for Probabilistic Roadmaps Random Sampling for capturing the connectivity of the C-space:

MAPRM

Page 58: Sampling Strategies for Probabilistic Roadmaps Random Sampling for capturing the connectivity of the C-space:

MAPRM

Page 59: Sampling Strategies for Probabilistic Roadmaps Random Sampling for capturing the connectivity of the C-space:

MAPRM

Page 60: Sampling Strategies for Probabilistic Roadmaps Random Sampling for capturing the connectivity of the C-space:

Results

Page 61: Sampling Strategies for Probabilistic Roadmaps Random Sampling for capturing the connectivity of the C-space:

Remarks

Not so efficient for any irregular shaped objects.

Page 62: Sampling Strategies for Probabilistic Roadmaps Random Sampling for capturing the connectivity of the C-space:

Remarks

Not so efficient for any irregular shaped objects.

Works only for 6-DOF rigid objects. Not for any n-DOF/ articulated robots.

Page 63: Sampling Strategies for Probabilistic Roadmaps Random Sampling for capturing the connectivity of the C-space:

Remarks

Not so efficient for any irregular shaped objects.

Works only for 6-DOF rigid objects. Not for any n-DOF/ articulated robots.For simple general cases it would take more time than basic PRM’s.

Page 64: Sampling Strategies for Probabilistic Roadmaps Random Sampling for capturing the connectivity of the C-space:

Conclusion

We saw 3 unique sampling strategies:

Visibility based Milestone management

Gaussian Sampling Capturing the c-obstacle boundaries

Medial axis sampling of free space- works in 3D space and for rigid bodies