sampling strategies for probabilistic roadmaps random sampling for capturing the connectivity of the...
Post on 21-Dec-2015
228 views
TRANSCRIPT
![Page 1: Sampling Strategies for Probabilistic Roadmaps Random Sampling for capturing the connectivity of the C-space:](https://reader036.vdocuments.us/reader036/viewer/2022062714/56649d565503460f94a3513d/html5/thumbnails/1.jpg)
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:](https://reader036.vdocuments.us/reader036/viewer/2022062714/56649d565503460f94a3513d/html5/thumbnails/2.jpg)
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:](https://reader036.vdocuments.us/reader036/viewer/2022062714/56649d565503460f94a3513d/html5/thumbnails/3.jpg)
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:](https://reader036.vdocuments.us/reader036/viewer/2022062714/56649d565503460f94a3513d/html5/thumbnails/4.jpg)
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:](https://reader036.vdocuments.us/reader036/viewer/2022062714/56649d565503460f94a3513d/html5/thumbnails/5.jpg)
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:](https://reader036.vdocuments.us/reader036/viewer/2022062714/56649d565503460f94a3513d/html5/thumbnails/6.jpg)
How efficient is the sampling strategy?
![Page 7: Sampling Strategies for Probabilistic Roadmaps Random Sampling for capturing the connectivity of the C-space:](https://reader036.vdocuments.us/reader036/viewer/2022062714/56649d565503460f94a3513d/html5/thumbnails/7.jpg)
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:](https://reader036.vdocuments.us/reader036/viewer/2022062714/56649d565503460f94a3513d/html5/thumbnails/8.jpg)
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:](https://reader036.vdocuments.us/reader036/viewer/2022062714/56649d565503460f94a3513d/html5/thumbnails/9.jpg)
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:](https://reader036.vdocuments.us/reader036/viewer/2022062714/56649d565503460f94a3513d/html5/thumbnails/10.jpg)
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:](https://reader036.vdocuments.us/reader036/viewer/2022062714/56649d565503460f94a3513d/html5/thumbnails/11.jpg)
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:](https://reader036.vdocuments.us/reader036/viewer/2022062714/56649d565503460f94a3513d/html5/thumbnails/12.jpg)
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:](https://reader036.vdocuments.us/reader036/viewer/2022062714/56649d565503460f94a3513d/html5/thumbnails/13.jpg)
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:](https://reader036.vdocuments.us/reader036/viewer/2022062714/56649d565503460f94a3513d/html5/thumbnails/14.jpg)
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:](https://reader036.vdocuments.us/reader036/viewer/2022062714/56649d565503460f94a3513d/html5/thumbnails/15.jpg)
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:](https://reader036.vdocuments.us/reader036/viewer/2022062714/56649d565503460f94a3513d/html5/thumbnails/16.jpg)
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:](https://reader036.vdocuments.us/reader036/viewer/2022062714/56649d565503460f94a3513d/html5/thumbnails/17.jpg)
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:](https://reader036.vdocuments.us/reader036/viewer/2022062714/56649d565503460f94a3513d/html5/thumbnails/18.jpg)
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:](https://reader036.vdocuments.us/reader036/viewer/2022062714/56649d565503460f94a3513d/html5/thumbnails/19.jpg)
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:](https://reader036.vdocuments.us/reader036/viewer/2022062714/56649d565503460f94a3513d/html5/thumbnails/20.jpg)
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:](https://reader036.vdocuments.us/reader036/viewer/2022062714/56649d565503460f94a3513d/html5/thumbnails/21.jpg)
Algorithm
![Page 22: Sampling Strategies for Probabilistic Roadmaps Random Sampling for capturing the connectivity of the C-space:](https://reader036.vdocuments.us/reader036/viewer/2022062714/56649d565503460f94a3513d/html5/thumbnails/22.jpg)
Algorithm
![Page 23: Sampling Strategies for Probabilistic Roadmaps Random Sampling for capturing the connectivity of the C-space:](https://reader036.vdocuments.us/reader036/viewer/2022062714/56649d565503460f94a3513d/html5/thumbnails/23.jpg)
Algorithm
![Page 24: Sampling Strategies for Probabilistic Roadmaps Random Sampling for capturing the connectivity of the C-space:](https://reader036.vdocuments.us/reader036/viewer/2022062714/56649d565503460f94a3513d/html5/thumbnails/24.jpg)
Algorithm
![Page 25: Sampling Strategies for Probabilistic Roadmaps Random Sampling for capturing the connectivity of the C-space:](https://reader036.vdocuments.us/reader036/viewer/2022062714/56649d565503460f94a3513d/html5/thumbnails/25.jpg)
Algorithm
![Page 26: Sampling Strategies for Probabilistic Roadmaps Random Sampling for capturing the connectivity of the C-space:](https://reader036.vdocuments.us/reader036/viewer/2022062714/56649d565503460f94a3513d/html5/thumbnails/26.jpg)
Algorithm
![Page 27: Sampling Strategies for Probabilistic Roadmaps Random Sampling for capturing the connectivity of the C-space:](https://reader036.vdocuments.us/reader036/viewer/2022062714/56649d565503460f94a3513d/html5/thumbnails/27.jpg)
Algorithm
![Page 28: Sampling Strategies for Probabilistic Roadmaps Random Sampling for capturing the connectivity of the C-space:](https://reader036.vdocuments.us/reader036/viewer/2022062714/56649d565503460f94a3513d/html5/thumbnails/28.jpg)
Algorithm
![Page 29: Sampling Strategies for Probabilistic Roadmaps Random Sampling for capturing the connectivity of the C-space:](https://reader036.vdocuments.us/reader036/viewer/2022062714/56649d565503460f94a3513d/html5/thumbnails/29.jpg)
Algorithm
![Page 30: Sampling Strategies for Probabilistic Roadmaps Random Sampling for capturing the connectivity of the C-space:](https://reader036.vdocuments.us/reader036/viewer/2022062714/56649d565503460f94a3513d/html5/thumbnails/30.jpg)
Results
6-dof puzzle example
![Page 31: Sampling Strategies for Probabilistic Roadmaps Random Sampling for capturing the connectivity of the C-space:](https://reader036.vdocuments.us/reader036/viewer/2022062714/56649d565503460f94a3513d/html5/thumbnails/31.jpg)
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:](https://reader036.vdocuments.us/reader036/viewer/2022062714/56649d565503460f94a3513d/html5/thumbnails/32.jpg)
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:](https://reader036.vdocuments.us/reader036/viewer/2022062714/56649d565503460f94a3513d/html5/thumbnails/33.jpg)
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:](https://reader036.vdocuments.us/reader036/viewer/2022062714/56649d565503460f94a3513d/html5/thumbnails/34.jpg)
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:](https://reader036.vdocuments.us/reader036/viewer/2022062714/56649d565503460f94a3513d/html5/thumbnails/35.jpg)
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:](https://reader036.vdocuments.us/reader036/viewer/2022062714/56649d565503460f94a3513d/html5/thumbnails/36.jpg)
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:](https://reader036.vdocuments.us/reader036/viewer/2022062714/56649d565503460f94a3513d/html5/thumbnails/37.jpg)
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:](https://reader036.vdocuments.us/reader036/viewer/2022062714/56649d565503460f94a3513d/html5/thumbnails/38.jpg)
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:](https://reader036.vdocuments.us/reader036/viewer/2022062714/56649d565503460f94a3513d/html5/thumbnails/39.jpg)
Algorithm
![Page 40: Sampling Strategies for Probabilistic Roadmaps Random Sampling for capturing the connectivity of the C-space:](https://reader036.vdocuments.us/reader036/viewer/2022062714/56649d565503460f94a3513d/html5/thumbnails/40.jpg)
Algorithm
![Page 41: Sampling Strategies for Probabilistic Roadmaps Random Sampling for capturing the connectivity of the C-space:](https://reader036.vdocuments.us/reader036/viewer/2022062714/56649d565503460f94a3513d/html5/thumbnails/41.jpg)
Algorithm
![Page 42: Sampling Strategies for Probabilistic Roadmaps Random Sampling for capturing the connectivity of the C-space:](https://reader036.vdocuments.us/reader036/viewer/2022062714/56649d565503460f94a3513d/html5/thumbnails/42.jpg)
Algorithm
![Page 43: Sampling Strategies for Probabilistic Roadmaps Random Sampling for capturing the connectivity of the C-space:](https://reader036.vdocuments.us/reader036/viewer/2022062714/56649d565503460f94a3513d/html5/thumbnails/43.jpg)
Algorithm
![Page 44: Sampling Strategies for Probabilistic Roadmaps Random Sampling for capturing the connectivity of the C-space:](https://reader036.vdocuments.us/reader036/viewer/2022062714/56649d565503460f94a3513d/html5/thumbnails/44.jpg)
Algorithm
![Page 45: Sampling Strategies for Probabilistic Roadmaps Random Sampling for capturing the connectivity of the C-space:](https://reader036.vdocuments.us/reader036/viewer/2022062714/56649d565503460f94a3513d/html5/thumbnails/45.jpg)
Algorithm
![Page 46: Sampling Strategies for Probabilistic Roadmaps Random Sampling for capturing the connectivity of the C-space:](https://reader036.vdocuments.us/reader036/viewer/2022062714/56649d565503460f94a3513d/html5/thumbnails/46.jpg)
![Page 47: Sampling Strategies for Probabilistic Roadmaps Random Sampling for capturing the connectivity of the C-space:](https://reader036.vdocuments.us/reader036/viewer/2022062714/56649d565503460f94a3513d/html5/thumbnails/47.jpg)
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:](https://reader036.vdocuments.us/reader036/viewer/2022062714/56649d565503460f94a3513d/html5/thumbnails/48.jpg)
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:](https://reader036.vdocuments.us/reader036/viewer/2022062714/56649d565503460f94a3513d/html5/thumbnails/49.jpg)
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:](https://reader036.vdocuments.us/reader036/viewer/2022062714/56649d565503460f94a3513d/html5/thumbnails/50.jpg)
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:](https://reader036.vdocuments.us/reader036/viewer/2022062714/56649d565503460f94a3513d/html5/thumbnails/51.jpg)
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:](https://reader036.vdocuments.us/reader036/viewer/2022062714/56649d565503460f94a3513d/html5/thumbnails/52.jpg)
MAPRM
![Page 53: Sampling Strategies for Probabilistic Roadmaps Random Sampling for capturing the connectivity of the C-space:](https://reader036.vdocuments.us/reader036/viewer/2022062714/56649d565503460f94a3513d/html5/thumbnails/53.jpg)
MAPRM
![Page 54: Sampling Strategies for Probabilistic Roadmaps Random Sampling for capturing the connectivity of the C-space:](https://reader036.vdocuments.us/reader036/viewer/2022062714/56649d565503460f94a3513d/html5/thumbnails/54.jpg)
MAPRM
![Page 55: Sampling Strategies for Probabilistic Roadmaps Random Sampling for capturing the connectivity of the C-space:](https://reader036.vdocuments.us/reader036/viewer/2022062714/56649d565503460f94a3513d/html5/thumbnails/55.jpg)
MAPRM
![Page 56: Sampling Strategies for Probabilistic Roadmaps Random Sampling for capturing the connectivity of the C-space:](https://reader036.vdocuments.us/reader036/viewer/2022062714/56649d565503460f94a3513d/html5/thumbnails/56.jpg)
MAPRM
![Page 57: Sampling Strategies for Probabilistic Roadmaps Random Sampling for capturing the connectivity of the C-space:](https://reader036.vdocuments.us/reader036/viewer/2022062714/56649d565503460f94a3513d/html5/thumbnails/57.jpg)
MAPRM
![Page 58: Sampling Strategies for Probabilistic Roadmaps Random Sampling for capturing the connectivity of the C-space:](https://reader036.vdocuments.us/reader036/viewer/2022062714/56649d565503460f94a3513d/html5/thumbnails/58.jpg)
MAPRM
![Page 59: Sampling Strategies for Probabilistic Roadmaps Random Sampling for capturing the connectivity of the C-space:](https://reader036.vdocuments.us/reader036/viewer/2022062714/56649d565503460f94a3513d/html5/thumbnails/59.jpg)
MAPRM
![Page 60: Sampling Strategies for Probabilistic Roadmaps Random Sampling for capturing the connectivity of the C-space:](https://reader036.vdocuments.us/reader036/viewer/2022062714/56649d565503460f94a3513d/html5/thumbnails/60.jpg)
Results
![Page 61: Sampling Strategies for Probabilistic Roadmaps Random Sampling for capturing the connectivity of the C-space:](https://reader036.vdocuments.us/reader036/viewer/2022062714/56649d565503460f94a3513d/html5/thumbnails/61.jpg)
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:](https://reader036.vdocuments.us/reader036/viewer/2022062714/56649d565503460f94a3513d/html5/thumbnails/62.jpg)
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:](https://reader036.vdocuments.us/reader036/viewer/2022062714/56649d565503460f94a3513d/html5/thumbnails/63.jpg)
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:](https://reader036.vdocuments.us/reader036/viewer/2022062714/56649d565503460f94a3513d/html5/thumbnails/64.jpg)
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