28
NUS CS5247 The Gaussian Sampling The Gaussian Sampling Strategy for Strategy for Probalistic Roadmap Probalistic Roadmap Planners Planners - Valdrie Boor, Mark H. Overmars, A. Frank van der Stappen, 1999 1999 Wai Kok Hoong Wai Kok Hoong

The Gaussian Sampling Strategy for Probalistic Roadmap Planners

  • Upload
    beyla

  • View
    35

  • Download
    0

Embed Size (px)

DESCRIPTION

The Gaussian Sampling Strategy for Probalistic Roadmap Planners. Valdrie Boor, Mark H. Overmars, A. Frank van der Stappen, 1999 Wai Kok Hoong. Sampling a Point Uniformly at Random – A Recap. repeat sample a configuration q with a suitable sampling strategy if q is collision-free then - PowerPoint PPT Presentation

Citation preview

Page 1: The Gaussian Sampling Strategy for Probalistic Roadmap Planners

NUS CS5247

The Gaussian Sampling The Gaussian Sampling Strategy for Strategy for

Probalistic Roadmap Probalistic Roadmap PlannersPlanners

-Valdrie Boor, Mark H. Overmars, A. Frank van der Stappen, 1999 1999

Wai Kok HoongWai Kok Hoong

Page 2: The Gaussian Sampling Strategy for Probalistic Roadmap Planners

NUS CS5247 2

Sampling a Point Uniformly at Random – A Recap

repeat

sample a configuration q with a suitable

sampling strategy

if q is collision-free then

add q to the roadmap R

connect q to existing milestones

return R

Page 3: The Gaussian Sampling Strategy for Probalistic Roadmap Planners

NUS CS5247 3

Sampling a Point Uniformly at Random – A Recap

repeat

sample a configuration q with a suitable

sampling strategy

if q is collision-free then

add q to the roadmap R

connect q to existing milestones

return R

Page 4: The Gaussian Sampling Strategy for Probalistic Roadmap Planners

NUS CS5247 4

The Gaussian Sampling Strategy for PRMs

Obstacle-sensitive strategy Idea: Sample near the boundaries of the C-

space obstacles with higher probability. Rationale: The connectivity of free space is more

difficult to capture near narrow passages than in wide-open area

Page 5: The Gaussian Sampling Strategy for Probalistic Roadmap Planners

NUS CS5247 5

The Gaussian Sampling Strategy for PRMs

Random Sampler (about 13000 samples)

Gaussian Sampler (about 150 samples)

Page 6: The Gaussian Sampling Strategy for Probalistic Roadmap Planners

NUS CS5247 6

The Gaussian Sampling Strategy for PRMs

Adopts the idea of Gaussian Blurring in image processing.

Page 7: The Gaussian Sampling Strategy for Probalistic Roadmap Planners

NUS CS5247 7

The Gaussian Sampling Strategy for PRMs

Algorithm

Page 8: The Gaussian Sampling Strategy for Probalistic Roadmap Planners

NUS CS5247 8

The Gaussian Sampling Strategy for PRMs

Algorithm

Page 9: The Gaussian Sampling Strategy for Probalistic Roadmap Planners

NUS CS5247 9

The Gaussian Sampling Strategy for PRMs

Algorithm

Page 10: The Gaussian Sampling Strategy for Probalistic Roadmap Planners

NUS CS5247 10

The Gaussian Sampling Strategy for PRMs

Algorithm

Page 11: The Gaussian Sampling Strategy for Probalistic Roadmap Planners

NUS CS5247 11

The Gaussian Sampling Strategy for PRMs

Algorithm

Page 12: The Gaussian Sampling Strategy for Probalistic Roadmap Planners

NUS CS5247 12

The Gaussian Sampling Strategy for PRMs

Algorithm

Page 13: The Gaussian Sampling Strategy for Probalistic Roadmap Planners

NUS CS5247 13

The Gaussian Sampling Strategy for PRMs

Algorithm

Page 14: The Gaussian Sampling Strategy for Probalistic Roadmap Planners

NUS CS5247 14

The Gaussian Sampling Strategy for PRMs

Algorithm

Page 15: The Gaussian Sampling Strategy for Probalistic Roadmap Planners

NUS CS5247 15

The Gaussian Sampling Strategy for PRMs

Algorithm

Page 16: The Gaussian Sampling Strategy for Probalistic Roadmap Planners

NUS CS5247 16

The Gaussian Sampling Strategy for PRMs

Algorithm

Page 17: The Gaussian Sampling Strategy for Probalistic Roadmap Planners

NUS CS5247 17

The Gaussian Sampling Strategy for PRMs

Algorithm

Page 18: The Gaussian Sampling Strategy for Probalistic Roadmap Planners

NUS CS5247 18

The Gaussian Sampling Strategy for PRMs

Page 19: The Gaussian Sampling Strategy for Probalistic Roadmap Planners

NUS CS5247 19

The Gaussian Sampling Strategy for PRMs

Pros May lead to discovery of narrow passages or

openings to narrow passages.

Cons The algorithm dose not distinguish between open

space boundaries and narrow passage boundaries.

Page 20: The Gaussian Sampling Strategy for Probalistic Roadmap Planners

NUS CS5247 20

The Gaussian Sampling Strategy for PRMs Extension

Use 3 samples instead of 2

Gaussian Sampler (using pairs)

Gaussian Sampler (using triples)

Page 21: The Gaussian Sampling Strategy for Probalistic Roadmap Planners

NUS CS5247 21

The Gaussian Sampling Strategy for PRMs – Experimental Results

Random sampler required about 13000 nodes.

Gaussian sampler required 150 nodes.

Random sampler took about 60 times longer than the Gaussian sampler.

Page 22: The Gaussian Sampling Strategy for Probalistic Roadmap Planners

NUS CS5247 22

The Gaussian Sampling Strategy for PRMs – Experimental Results

A scene requiring a difficult twist of the robot.

Random sampler required about 10000 nodes.

Gaussian sampler required 750 nodes.

Random sampler took about 13 times longer than the Gaussian sampler.

Page 23: The Gaussian Sampling Strategy for Probalistic Roadmap Planners

NUS CS5247 23

The Gaussian Sampling Strategy for PRMs – Experimental Results

A scene with 5000 obstacles. Random sampler required

over 450 nodes. Gaussian sampler required

about 85 nodes. Random sampler took about

4 times longer than the Gaussian sampler.

Page 24: The Gaussian Sampling Strategy for Probalistic Roadmap Planners

NUS CS5247 24

The Gaussian Sampling Strategy for PRMs – Experimental Results Running time of algorithm increases when sigma is

chosen to be very small because hard to find a pair of nodes that generates a successful sample, thus performance deterioration.

When sigma is chosen to be very large, output of sampler started to approximate random sampling, thus performance also deteriorated.

Choose sigma such that most configurations lie at a distance of at most the length of the robot from the obstacles.

Page 25: The Gaussian Sampling Strategy for Probalistic Roadmap Planners

NUS CS5247 25

The Bridge Test for Sampling Narrow Passages with PRMs Narrow-passage strategy Rationale: Finding the connectivity of the free space

through narrow passage is the only hard problem.

Page 26: The Gaussian Sampling Strategy for Probalistic Roadmap Planners

NUS CS5247 26

The Bridge Test for Sampling Narrow Passages with PRMs The bridge test most likely yields a high rejection

rate of configurations It generally results in a smaller number of

milestones, hence fewer connections to be tested

Since testing connections is costly, there can be significant computational gain

Page 27: The Gaussian Sampling Strategy for Probalistic Roadmap Planners

NUS CS5247 27

Comparison between Gaussian Sampling and Bridge Test

Gaussian Sampling Bridge Test

Page 28: The Gaussian Sampling Strategy for Probalistic Roadmap Planners

NUS CS5247 28

Summary Sample near the boundaries of the C-space obstacles The connectivity of free space is more difficult to capture

near its narrow passages than in wide-open area Random Sampler is faster in scenes where the obstacles

are reasonably distributed with wide corridors. Gaussian Sampler is faster in scenes where there is

varying obstacle density, resulting in large open areas and small passages.

~ The End ~