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

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
  • date post

    21-Dec-2015
  • Category

    Documents

  • view

    214
  • download

    0

Transcript of Robust Monte Carlo Localization for Mobile Robots Thomas Coffee Based on: Thrun S, Fox D, Burgard W,...

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