27
oratory for Perceptual Robotics – Department of Computer Science Whole-Body Collision- Free Motion Planning Brendan Burns Laboratory for Perceptual Robotics University of Massachusetts Amherst

Laboratory for Perceptual Robotics – Department of Computer Science Whole-Body Collision-Free Motion Planning Brendan Burns Laboratory for Perceptual Robotics

  • View
    220

  • Download
    0

Embed Size (px)

Citation preview

Page 1: Laboratory for Perceptual Robotics – Department of Computer Science Whole-Body Collision-Free Motion Planning Brendan Burns Laboratory for Perceptual Robotics

Laboratory for Perceptual Robotics – Department of Computer Science

Whole-Body Collision-Free Motion Planning

Brendan BurnsLaboratory for Perceptual Robotics

University of Massachusetts Amherst

Page 2: Laboratory for Perceptual Robotics – Department of Computer Science Whole-Body Collision-Free Motion Planning Brendan Burns Laboratory for Perceptual Robotics

2Laboratory for Perceptual Robotics – Department of Computer Science

Why motion planning?

The real world is complicated

Collisions are hazardous

Mobility

Page 3: Laboratory for Perceptual Robotics – Department of Computer Science Whole-Body Collision-Free Motion Planning Brendan Burns Laboratory for Perceptual Robotics

3Laboratory for Perceptual Robotics – Department of Computer Science

How to motion plan?

Configuration space is big! (exponential) Exact methods are intractable Sampling-Based Planning (PRM)

Page 4: Laboratory for Perceptual Robotics – Department of Computer Science Whole-Body Collision-Free Motion Planning Brendan Burns Laboratory for Perceptual Robotics

4Laboratory for Perceptual Robotics – Department of Computer Science

Probabilistic Roadmap PlanningKavraki & Overmars 1996

?

Page 5: Laboratory for Perceptual Robotics – Department of Computer Science Whole-Body Collision-Free Motion Planning Brendan Burns Laboratory for Perceptual Robotics

5Laboratory for Perceptual Robotics – Department of Computer Science

12

3

6

7

8

9

5 4

10

6

3 8

942

[1..5] [7..10]

[1..2][4..5] [9..10]

Page 6: Laboratory for Perceptual Robotics – Department of Computer Science Whole-Body Collision-Free Motion Planning Brendan Burns Laboratory for Perceptual Robotics

6Laboratory for Perceptual Robotics – Department of Computer Science

Structure & Exploration

Identify the structure to expect

Acquire knowledge about structure

Exploit understanding as a guide

Page 7: Laboratory for Perceptual Robotics – Department of Computer Science Whole-Body Collision-Free Motion Planning Brendan Burns Laboratory for Perceptual Robotics

7Laboratory for Perceptual Robotics – Department of Computer Science

Models

Page 8: Laboratory for Perceptual Robotics – Department of Computer Science Whole-Body Collision-Free Motion Planning Brendan Burns Laboratory for Perceptual Robotics

8Laboratory for Perceptual Robotics – Department of Computer Science

Predictive Models

Page 9: Laboratory for Perceptual Robotics – Department of Computer Science Whole-Body Collision-Free Motion Planning Brendan Burns Laboratory for Perceptual Robotics

9Laboratory for Perceptual Robotics – Department of Computer Science

Active Sampling

Page 10: Laboratory for Perceptual Robotics – Department of Computer Science Whole-Body Collision-Free Motion Planning Brendan Burns Laboratory for Perceptual Robotics

10Laboratory for Perceptual Robotics – Department of Computer Science

Predictive Edge Checking

Edge checking is expensive

Our predictive model already exists

Construct a predictive roadmap

Page 11: Laboratory for Perceptual Robotics – Department of Computer Science Whole-Body Collision-Free Motion Planning Brendan Burns Laboratory for Perceptual Robotics

11Laboratory for Perceptual Robotics – Department of Computer Science

Predictive Roadmaps

Page 12: Laboratory for Perceptual Robotics – Department of Computer Science Whole-Body Collision-Free Motion Planning Brendan Burns Laboratory for Perceptual Robotics

12Laboratory for Perceptual Robotics – Department of Computer Science

Path Extraction

Page 13: Laboratory for Perceptual Robotics – Department of Computer Science Whole-Body Collision-Free Motion Planning Brendan Burns Laboratory for Perceptual Robotics

13Laboratory for Perceptual Robotics – Department of Computer Science

Path Extraction

Page 14: Laboratory for Perceptual Robotics – Department of Computer Science Whole-Body Collision-Free Motion Planning Brendan Burns Laboratory for Perceptual Robotics

14Laboratory for Perceptual Robotics – Department of Computer Science

Path Extraction

Page 15: Laboratory for Perceptual Robotics – Department of Computer Science Whole-Body Collision-Free Motion Planning Brendan Burns Laboratory for Perceptual Robotics

15Laboratory for Perceptual Robotics – Department of Computer Science

Path Extraction

Page 16: Laboratory for Perceptual Robotics – Department of Computer Science Whole-Body Collision-Free Motion Planning Brendan Burns Laboratory for Perceptual Robotics

16Laboratory for Perceptual Robotics – Department of Computer Science

Path Extraction

Page 17: Laboratory for Perceptual Robotics – Department of Computer Science Whole-Body Collision-Free Motion Planning Brendan Burns Laboratory for Perceptual Robotics

17Laboratory for Perceptual Robotics – Department of Computer Science

Experiments

Page 18: Laboratory for Perceptual Robotics – Department of Computer Science Whole-Body Collision-Free Motion Planning Brendan Burns Laboratory for Perceptual Robotics

18Laboratory for Perceptual Robotics – Department of Computer Science

0

20

40

60

80

100

120

Uniform Bridge Active Predictive

Guided Sampling Path ExtractionEdge Validation Collision CheckRoadmap Building

9-DOF

Page 19: Laboratory for Perceptual Robotics – Department of Computer Science Whole-Body Collision-Free Motion Planning Brendan Burns Laboratory for Perceptual Robotics

19Laboratory for Perceptual Robotics – Department of Computer Science

0

20

40

60

80

100

120

140

Uniform Bridge Active Predictive

Guided Sampling Path ExtractionEdge Validation Collision CheckRoadmap Building

12-DOF

Page 20: Laboratory for Perceptual Robotics – Department of Computer Science Whole-Body Collision-Free Motion Planning Brendan Burns Laboratory for Perceptual Robotics

20Laboratory for Perceptual Robotics – Department of Computer Science

Coming Soon…

Page 21: Laboratory for Perceptual Robotics – Department of Computer Science Whole-Body Collision-Free Motion Planning Brendan Burns Laboratory for Perceptual Robotics

21Laboratory for Perceptual Robotics – Department of Computer Science

Stop

Page 22: Laboratory for Perceptual Robotics – Department of Computer Science Whole-Body Collision-Free Motion Planning Brendan Burns Laboratory for Perceptual Robotics

22Laboratory for Perceptual Robotics – Department of Computer Science

Models

Page 23: Laboratory for Perceptual Robotics – Department of Computer Science Whole-Body Collision-Free Motion Planning Brendan Burns Laboratory for Perceptual Robotics

23Laboratory for Perceptual Robotics – Department of Computer Science

Optimal Sampling

Page 24: Laboratory for Perceptual Robotics – Department of Computer Science Whole-Body Collision-Free Motion Planning Brendan Burns Laboratory for Perceptual Robotics

24Laboratory for Perceptual Robotics – Department of Computer Science

Optimal Sampling

?

Page 25: Laboratory for Perceptual Robotics – Department of Computer Science Whole-Body Collision-Free Motion Planning Brendan Burns Laboratory for Perceptual Robotics

25Laboratory for Perceptual Robotics – Department of Computer Science

Active Sampling

Page 26: Laboratory for Perceptual Robotics – Department of Computer Science Whole-Body Collision-Free Motion Planning Brendan Burns Laboratory for Perceptual Robotics

26Laboratory for Perceptual Robotics – Department of Computer Science

Models

An approximate model of our current understanding

Predicts the state of unobserved configuration-space

Locally Weighted Regression (Atkeson et al.) Others are possible

Page 27: Laboratory for Perceptual Robotics – Department of Computer Science Whole-Body Collision-Free Motion Planning Brendan Burns Laboratory for Perceptual Robotics

27Laboratory for Perceptual Robotics – Department of Computer Science

Active Sampling

Our current understanding suggests areas of improvement

Sample to reduce maximize the expected reduction in model variance (Cohn et al.)

Direct sampling in proportion to complexity