37
Robust Monte Carlo Localization for Mobile Robots Thomas Coffee Based on: Thrun S, Fox D, Burgard W, Dellaert F Robust Monte Carlo Localization for Mobile Robots (2001) Artificial Intelligence 128(1-2): mage: Thrun et al. 2001

Robust Monte Carlo Localization for Mobile Robots Thomas Coffee Based on: Thrun S, Fox D, Burgard W, Dellaert F Robust Monte Carlo Localization for Mobile

  • View
    214

  • Download
    0

Embed Size (px)

Citation preview

Page 1: Robust Monte Carlo Localization for Mobile Robots Thomas Coffee Based on: Thrun S, Fox D, Burgard W, Dellaert F Robust Monte Carlo Localization for Mobile

Robust Monte Carlo Localization for Mobile Robots

Thomas Coffee

Based on:

Thrun S, Fox D, Burgard W, Dellaert F

Robust Monte Carlo Localization for Mobile Robots (2001)

Artificial Intelligence 128(1-2): 99-141

Image: Thrun et al. 2001

Page 2: Robust Monte Carlo Localization for Mobile Robots Thomas Coffee Based on: Thrun S, Fox D, Burgard W, Dellaert F Robust Monte Carlo Localization for Mobile

2

The Problem of Localization

Image: Fox et al. 1999

Page 3: Robust Monte Carlo Localization for Mobile Robots Thomas Coffee Based on: Thrun S, Fox D, Burgard W, Dellaert F Robust Monte Carlo Localization for Mobile

3

Tracking vs. Global Localization

Page 4: Robust Monte Carlo Localization for Mobile Robots Thomas Coffee Based on: Thrun S, Fox D, Burgard W, Dellaert F Robust Monte Carlo Localization for Mobile

4

Global Localization Requires Multi-Modal Belief Representations

Image: Fox et al. 1999

Page 5: Robust Monte Carlo Localization for Mobile Robots Thomas Coffee Based on: Thrun S, Fox D, Burgard W, Dellaert F Robust Monte Carlo Localization for Mobile

5

Global Localization for a Mobile Robot

Image: Thrun et al. 2001

Page 6: Robust Monte Carlo Localization for Mobile Robots Thomas Coffee Based on: Thrun S, Fox D, Burgard W, Dellaert F Robust Monte Carlo Localization for Mobile

6

Multi-Hypothesis Kalman Filtering

Image: Roumeliotis et al. 2000

Page 7: Robust Monte Carlo Localization for Mobile Robots Thomas Coffee Based on: Thrun S, Fox D, Burgard W, Dellaert F Robust Monte Carlo Localization for Mobile

7

Real Errors are Non-Gaussian!

Image: Thrun et al. 2001

Page 8: Robust Monte Carlo Localization for Mobile Robots Thomas Coffee Based on: Thrun S, Fox D, Burgard W, Dellaert F Robust Monte Carlo Localization for Mobile

8

Markov Localization (ML)

Image: Fox et al. 1999

Page 9: Robust Monte Carlo Localization for Mobile Robots Thomas Coffee Based on: Thrun S, Fox D, Burgard W, Dellaert F Robust Monte Carlo Localization for Mobile

9

Particle Filters to the Rescue!

Image: Thrun et al. 2001

Page 10: Robust Monte Carlo Localization for Mobile Robots Thomas Coffee Based on: Thrun S, Fox D, Burgard W, Dellaert F Robust Monte Carlo Localization for Mobile

10

Monte Carlo Localization (MCL)

Imag

e: T

hrun

et a

l. 20

01

Page 11: Robust Monte Carlo Localization for Mobile Robots Thomas Coffee Based on: Thrun S, Fox D, Burgard W, Dellaert F Robust Monte Carlo Localization for Mobile

11

Monte Carlo Localization (MCL)

Imag

e: T

hrun

et a

l. 20

01

Page 12: Robust Monte Carlo Localization for Mobile Robots Thomas Coffee Based on: Thrun S, Fox D, Burgard W, Dellaert F Robust Monte Carlo Localization for Mobile

12

Monte Carlo Localization (MCL)

Imag

e: T

hrun

et a

l. 20

01

Page 13: Robust Monte Carlo Localization for Mobile Robots Thomas Coffee Based on: Thrun S, Fox D, Burgard W, Dellaert F Robust Monte Carlo Localization for Mobile

13

How MCL Works

Page 14: Robust Monte Carlo Localization for Mobile Robots Thomas Coffee Based on: Thrun S, Fox D, Burgard W, Dellaert F Robust Monte Carlo Localization for Mobile

14

Performance of MCL vs. ML

Imag

e: T

hrun

et a

l. 20

01

Page 15: Robust Monte Carlo Localization for Mobile Robots Thomas Coffee Based on: Thrun S, Fox D, Burgard W, Dellaert F Robust Monte Carlo Localization for Mobile

15

Simulated Object Localization with MCL

Image: Thrun et al. 2001

Page 16: Robust Monte Carlo Localization for Mobile Robots Thomas Coffee Based on: Thrun S, Fox D, Burgard W, Dellaert F Robust Monte Carlo Localization for Mobile

16

Better Sensors = Larger Errors?

Image: Thrun et al. 2001

Page 17: Robust Monte Carlo Localization for Mobile Robots Thomas Coffee Based on: Thrun S, Fox D, Burgard W, Dellaert F Robust Monte Carlo Localization for Mobile

17

Object Localization Failure with MCL

Image: Thrun et al. 2001

Page 18: Robust Monte Carlo Localization for Mobile Robots Thomas Coffee Based on: Thrun S, Fox D, Burgard W, Dellaert F Robust Monte Carlo Localization for Mobile

18

What Went Wrong?

Page 19: Robust Monte Carlo Localization for Mobile Robots Thomas Coffee Based on: Thrun S, Fox D, Burgard W, Dellaert F Robust Monte Carlo Localization for Mobile

19

A Quick Fix for MCL

Image: Thrun et al. 2001

Page 20: Robust Monte Carlo Localization for Mobile Robots Thomas Coffee Based on: Thrun S, Fox D, Burgard W, Dellaert F Robust Monte Carlo Localization for Mobile

20

Key Idea: Dual Sampling MCL

Page 21: Robust Monte Carlo Localization for Mobile Robots Thomas Coffee Based on: Thrun S, Fox D, Burgard W, Dellaert F Robust Monte Carlo Localization for Mobile

21

Kernel Density Trees: Computing Densities from Particle Fields

Image: Fox et al. 2000

Page 22: Robust Monte Carlo Localization for Mobile Robots Thomas Coffee Based on: Thrun S, Fox D, Burgard W, Dellaert F Robust Monte Carlo Localization for Mobile

22

Results of Dual MCL

Image: Thrun et al. 2001

Page 23: Robust Monte Carlo Localization for Mobile Robots Thomas Coffee Based on: Thrun S, Fox D, Burgard W, Dellaert F Robust Monte Carlo Localization for Mobile

23

Mixture-MCL: Best of Both Breeds

Image: Thrun et al. 2001

Page 24: Robust Monte Carlo Localization for Mobile Robots Thomas Coffee Based on: Thrun S, Fox D, Burgard W, Dellaert F Robust Monte Carlo Localization for Mobile

24

Results for Small Samples

Image: Thrun et al. 2001

Page 25: Robust Monte Carlo Localization for Mobile Robots Thomas Coffee Based on: Thrun S, Fox D, Burgard W, Dellaert F Robust Monte Carlo Localization for Mobile

25

Results for the Kidnapping Problem

Image: Thrun et al. 2001

Page 26: Robust Monte Carlo Localization for Mobile Robots Thomas Coffee Based on: Thrun S, Fox D, Burgard W, Dellaert F Robust Monte Carlo Localization for Mobile

26

Real Implementation of Mixture-MCL: Sampling Poses from Observations

Page 27: Robust Monte Carlo Localization for Mobile Robots Thomas Coffee Based on: Thrun S, Fox D, Burgard W, Dellaert F Robust Monte Carlo Localization for Mobile

27

Mixture-MCL in Action

Imag

e: T

hrun

et a

l. 20

01

Page 28: Robust Monte Carlo Localization for Mobile Robots Thomas Coffee Based on: Thrun S, Fox D, Burgard W, Dellaert F Robust Monte Carlo Localization for Mobile

28

Mixture-MCL in Action

Imag

e: T

hrun

et a

l. 20

01

Page 29: Robust Monte Carlo Localization for Mobile Robots Thomas Coffee Based on: Thrun S, Fox D, Burgard W, Dellaert F Robust Monte Carlo Localization for Mobile

29

Mixture-MCL in Action

Imag

e: T

hrun

et a

l. 20

01

Page 30: Robust Monte Carlo Localization for Mobile Robots Thomas Coffee Based on: Thrun S, Fox D, Burgard W, Dellaert F Robust Monte Carlo Localization for Mobile

30

Results for Real Implementation

Image: Thrun et al. 2001

Page 31: Robust Monte Carlo Localization for Mobile Robots Thomas Coffee Based on: Thrun S, Fox D, Burgard W, Dellaert F Robust Monte Carlo Localization for Mobile

31

Is Mixture-MCL Efficient?

Image: Thrun et al. 2001

Page 32: Robust Monte Carlo Localization for Mobile Robots Thomas Coffee Based on: Thrun S, Fox D, Burgard W, Dellaert F Robust Monte Carlo Localization for Mobile

32

Almost as Fast as Standard MCL!

Image: Thrun et al. 2001

Page 33: Robust Monte Carlo Localization for Mobile Robots Thomas Coffee Based on: Thrun S, Fox D, Burgard W, Dellaert F Robust Monte Carlo Localization for Mobile

33

Advantages of Mixture-MCL

Page 34: Robust Monte Carlo Localization for Mobile Robots Thomas Coffee Based on: Thrun S, Fox D, Burgard W, Dellaert F Robust Monte Carlo Localization for Mobile

34

Related Work and Applications

Page 35: Robust Monte Carlo Localization for Mobile Robots Thomas Coffee Based on: Thrun S, Fox D, Burgard W, Dellaert F Robust Monte Carlo Localization for Mobile

35

Limitations and Assumptions

Page 36: Robust Monte Carlo Localization for Mobile Robots Thomas Coffee Based on: Thrun S, Fox D, Burgard W, Dellaert F Robust Monte Carlo Localization for Mobile

36

Future Extensions to Mixture-MCL

Page 37: Robust Monte Carlo Localization for Mobile Robots Thomas Coffee Based on: Thrun S, Fox D, Burgard W, Dellaert F Robust Monte Carlo Localization for Mobile

37

Thank you!

Image: Thrun et al. 1999