Advanced Techniques for Mobile Robotics Gaussian...

64
Wolfram Burgard, Cyrill Stachniss, Kai Arras, Maren Bennewitz Gaussian Processes in Robotics Advanced Techniques for Mobile Robotics

Transcript of Advanced Techniques for Mobile Robotics Gaussian...

Page 1: Advanced Techniques for Mobile Robotics Gaussian …ais.informatik.uni-freiburg.de/.../pdfs/rob2-14-gaussian-processes.pdf · Wolfram Burgard, Cyrill Stachniss, Kai Arras, Maren Bennewitz

Wolfram Burgard, Cyrill Stachniss,

Kai Arras, Maren Bennewitz

Gaussian Processes in Robotics

Advanced Techniques for Mobile Robotics

Page 2: Advanced Techniques for Mobile Robotics Gaussian …ais.informatik.uni-freiburg.de/.../pdfs/rob2-14-gaussian-processes.pdf · Wolfram Burgard, Cyrill Stachniss, Kai Arras, Maren Bennewitz

Overview

§  Regression problem

§  Gaussian process models

§  Learning GPs

§  Applications

§  Summary

Page 3: Advanced Techniques for Mobile Robotics Gaussian …ais.informatik.uni-freiburg.de/.../pdfs/rob2-14-gaussian-processes.pdf · Wolfram Burgard, Cyrill Stachniss, Kai Arras, Maren Bennewitz

The Regression Problem §  Given n observed points

§  Assuming the dependency

§  How to predict new points

Page 4: Advanced Techniques for Mobile Robotics Gaussian …ais.informatik.uni-freiburg.de/.../pdfs/rob2-14-gaussian-processes.pdf · Wolfram Burgard, Cyrill Stachniss, Kai Arras, Maren Bennewitz

The Regression Problem §  Given n observed points

Page 5: Advanced Techniques for Mobile Robotics Gaussian …ais.informatik.uni-freiburg.de/.../pdfs/rob2-14-gaussian-processes.pdf · Wolfram Burgard, Cyrill Stachniss, Kai Arras, Maren Bennewitz

The Regression Problem §  Solution 1: Parametric models

§  Linear

§ Quadratic

§ Higher order polynomials

§ …

§  Learning: optimizing the parameters

Page 6: Advanced Techniques for Mobile Robotics Gaussian …ais.informatik.uni-freiburg.de/.../pdfs/rob2-14-gaussian-processes.pdf · Wolfram Burgard, Cyrill Stachniss, Kai Arras, Maren Bennewitz

The Regression Problem §  Solution 1: Parametric models

Page 7: Advanced Techniques for Mobile Robotics Gaussian …ais.informatik.uni-freiburg.de/.../pdfs/rob2-14-gaussian-processes.pdf · Wolfram Burgard, Cyrill Stachniss, Kai Arras, Maren Bennewitz

The Regression Problem §  Solution 1: Parametric models

Page 8: Advanced Techniques for Mobile Robotics Gaussian …ais.informatik.uni-freiburg.de/.../pdfs/rob2-14-gaussian-processes.pdf · Wolfram Burgard, Cyrill Stachniss, Kai Arras, Maren Bennewitz

The Regression Problem §  Solution 2: Non-parametric models

§  Radial Basis functions

§ Histograms, Splines, Support Vector Machines …

§  Learning: finding the structure of the model and optimize its parameters

Page 9: Advanced Techniques for Mobile Robotics Gaussian …ais.informatik.uni-freiburg.de/.../pdfs/rob2-14-gaussian-processes.pdf · Wolfram Burgard, Cyrill Stachniss, Kai Arras, Maren Bennewitz

The Regression Problem §  Given n observed points

Page 10: Advanced Techniques for Mobile Robotics Gaussian …ais.informatik.uni-freiburg.de/.../pdfs/rob2-14-gaussian-processes.pdf · Wolfram Burgard, Cyrill Stachniss, Kai Arras, Maren Bennewitz

The Regression Problem §  Solution 3: Express

directly in terms of the data points

§  Idea: Any finite set of values sampled from has a joint Gaussian distribution with a covariance matrix given by

Page 11: Advanced Techniques for Mobile Robotics Gaussian …ais.informatik.uni-freiburg.de/.../pdfs/rob2-14-gaussian-processes.pdf · Wolfram Burgard, Cyrill Stachniss, Kai Arras, Maren Bennewitz

Gaussian Process Models §  Then, the n+1 dimensional vector

which includes the new target to be predicted , comes from an n+1 dimensional Gaussian

§  The predictive distribution for the new target is a 1-dimensional Gaussian

Page 12: Advanced Techniques for Mobile Robotics Gaussian …ais.informatik.uni-freiburg.de/.../pdfs/rob2-14-gaussian-processes.pdf · Wolfram Burgard, Cyrill Stachniss, Kai Arras, Maren Bennewitz

§  Given the n observed points §  Squared exponential covariance

function

§  with §  and a noise level

Gaussian Process Model

Page 13: Advanced Techniques for Mobile Robotics Gaussian …ais.informatik.uni-freiburg.de/.../pdfs/rob2-14-gaussian-processes.pdf · Wolfram Burgard, Cyrill Stachniss, Kai Arras, Maren Bennewitz

The Regression Problem §  Given n observed points

Page 14: Advanced Techniques for Mobile Robotics Gaussian …ais.informatik.uni-freiburg.de/.../pdfs/rob2-14-gaussian-processes.pdf · Wolfram Burgard, Cyrill Stachniss, Kai Arras, Maren Bennewitz

Gaussian Process Models §  GP model

Page 15: Advanced Techniques for Mobile Robotics Gaussian …ais.informatik.uni-freiburg.de/.../pdfs/rob2-14-gaussian-processes.pdf · Wolfram Burgard, Cyrill Stachniss, Kai Arras, Maren Bennewitz

Learning GPs §  The squared exponential

covariance function:

§  Easy to interpret parameters

amplitude

index/input distance

characteristic lengthscale

noise level

Page 16: Advanced Techniques for Mobile Robotics Gaussian …ais.informatik.uni-freiburg.de/.../pdfs/rob2-14-gaussian-processes.pdf · Wolfram Burgard, Cyrill Stachniss, Kai Arras, Maren Bennewitz

Learning GPs §  Example: low noise

Page 17: Advanced Techniques for Mobile Robotics Gaussian …ais.informatik.uni-freiburg.de/.../pdfs/rob2-14-gaussian-processes.pdf · Wolfram Burgard, Cyrill Stachniss, Kai Arras, Maren Bennewitz

Learning GPs §  Example: medium noise

Page 18: Advanced Techniques for Mobile Robotics Gaussian …ais.informatik.uni-freiburg.de/.../pdfs/rob2-14-gaussian-processes.pdf · Wolfram Burgard, Cyrill Stachniss, Kai Arras, Maren Bennewitz

Learning GPs §  Example: high noise

Page 19: Advanced Techniques for Mobile Robotics Gaussian …ais.informatik.uni-freiburg.de/.../pdfs/rob2-14-gaussian-processes.pdf · Wolfram Burgard, Cyrill Stachniss, Kai Arras, Maren Bennewitz

Learning GPs §  Example: small lengthscale

Page 20: Advanced Techniques for Mobile Robotics Gaussian …ais.informatik.uni-freiburg.de/.../pdfs/rob2-14-gaussian-processes.pdf · Wolfram Burgard, Cyrill Stachniss, Kai Arras, Maren Bennewitz

Learning GPs §  Example: large lengthscale

Page 21: Advanced Techniques for Mobile Robotics Gaussian …ais.informatik.uni-freiburg.de/.../pdfs/rob2-14-gaussian-processes.pdf · Wolfram Burgard, Cyrill Stachniss, Kai Arras, Maren Bennewitz

Learning GPs §  Covariance function specifies the prior

prior posterior

Page 22: Advanced Techniques for Mobile Robotics Gaussian …ais.informatik.uni-freiburg.de/.../pdfs/rob2-14-gaussian-processes.pdf · Wolfram Burgard, Cyrill Stachniss, Kai Arras, Maren Bennewitz

Gaussian Process Models §  Recall, the n+1 dimensional vector

comes from an n+1 dimensional normal distribution

§  The predictive distribution for the new target is a 1-dimensional Gaussian.

§  Why?

Page 23: Advanced Techniques for Mobile Robotics Gaussian …ais.informatik.uni-freiburg.de/.../pdfs/rob2-14-gaussian-processes.pdf · Wolfram Burgard, Cyrill Stachniss, Kai Arras, Maren Bennewitz

The Gaussian Distribution §  Recall the 2-dimensional joint Gaussian:

§  The conditionals and the marginals are also Gaussians Figure taken from

Carl E. Rasmussen: NIPS 2006 Tutorial

Page 24: Advanced Techniques for Mobile Robotics Gaussian …ais.informatik.uni-freiburg.de/.../pdfs/rob2-14-gaussian-processes.pdf · Wolfram Burgard, Cyrill Stachniss, Kai Arras, Maren Bennewitz

The Gaussian Distribution §  Simple bivariate example:

Page 25: Advanced Techniques for Mobile Robotics Gaussian …ais.informatik.uni-freiburg.de/.../pdfs/rob2-14-gaussian-processes.pdf · Wolfram Burgard, Cyrill Stachniss, Kai Arras, Maren Bennewitz

The Gaussian Distribution §  Simple bivariate example:

joint

marginal conditional

Page 26: Advanced Techniques for Mobile Robotics Gaussian …ais.informatik.uni-freiburg.de/.../pdfs/rob2-14-gaussian-processes.pdf · Wolfram Burgard, Cyrill Stachniss, Kai Arras, Maren Bennewitz

The Gaussian Distribution § Marginalization:

Page 27: Advanced Techniques for Mobile Robotics Gaussian …ais.informatik.uni-freiburg.de/.../pdfs/rob2-14-gaussian-processes.pdf · Wolfram Burgard, Cyrill Stachniss, Kai Arras, Maren Bennewitz

The Gaussian Distribution §  The conditional:

Page 28: Advanced Techniques for Mobile Robotics Gaussian …ais.informatik.uni-freiburg.de/.../pdfs/rob2-14-gaussian-processes.pdf · Wolfram Burgard, Cyrill Stachniss, Kai Arras, Maren Bennewitz

The Gaussian Distribution §  Slightly more complicated in the general

case:

§  The conditionals and the marginals are also Gaussians

Figure taken from Carl E. Rasmussen: NIPS 2006 Tutorial

Page 29: Advanced Techniques for Mobile Robotics Gaussian …ais.informatik.uni-freiburg.de/.../pdfs/rob2-14-gaussian-processes.pdf · Wolfram Burgard, Cyrill Stachniss, Kai Arras, Maren Bennewitz

The Gaussian Distribution §  Conditioning the joint Gaussian in general

§  In case of zero mean:

Page 30: Advanced Techniques for Mobile Robotics Gaussian …ais.informatik.uni-freiburg.de/.../pdfs/rob2-14-gaussian-processes.pdf · Wolfram Burgard, Cyrill Stachniss, Kai Arras, Maren Bennewitz

Gaussian Process Models §  Recall the GP assumption

Page 31: Advanced Techniques for Mobile Robotics Gaussian …ais.informatik.uni-freiburg.de/.../pdfs/rob2-14-gaussian-processes.pdf · Wolfram Burgard, Cyrill Stachniss, Kai Arras, Maren Bennewitz

Gaussian Process Models §  Noise-free mean and variance of the

predictive distribution have the form

§  with

Page 32: Advanced Techniques for Mobile Robotics Gaussian …ais.informatik.uni-freiburg.de/.../pdfs/rob2-14-gaussian-processes.pdf · Wolfram Burgard, Cyrill Stachniss, Kai Arras, Maren Bennewitz

Gaussian Process Models §  Mean and variance of the predictive

distribution then lead to

§  with

Page 33: Advanced Techniques for Mobile Robotics Gaussian …ais.informatik.uni-freiburg.de/.../pdfs/rob2-14-gaussian-processes.pdf · Wolfram Burgard, Cyrill Stachniss, Kai Arras, Maren Bennewitz

Learning GPs §  Learning a Gaussian process means

§  choosing a covariance function §  finding its parameters and the noise level

§  What is the objective?

Page 34: Advanced Techniques for Mobile Robotics Gaussian …ais.informatik.uni-freiburg.de/.../pdfs/rob2-14-gaussian-processes.pdf · Wolfram Burgard, Cyrill Stachniss, Kai Arras, Maren Bennewitz

Learning GPs §  The hyperparameters

can be found by maximizing the likelihood of the training data e.g., using gradient methods

Page 35: Advanced Techniques for Mobile Robotics Gaussian …ais.informatik.uni-freiburg.de/.../pdfs/rob2-14-gaussian-processes.pdf · Wolfram Burgard, Cyrill Stachniss, Kai Arras, Maren Bennewitz

Learning GPs §  Objective: high data likelihood

§  Due to the Gaussian assumption, GPs have Occam’s razor built in

data fit complexity penalty

const.

Page 36: Advanced Techniques for Mobile Robotics Gaussian …ais.informatik.uni-freiburg.de/.../pdfs/rob2-14-gaussian-processes.pdf · Wolfram Burgard, Cyrill Stachniss, Kai Arras, Maren Bennewitz

Occam‘s Razor §  Use the simplest explanation that is

needed to describe the data

§  Data-fit favors overfitting §  Complexity penalty favors simplicity

too long just right too short

Page 37: Advanced Techniques for Mobile Robotics Gaussian …ais.informatik.uni-freiburg.de/.../pdfs/rob2-14-gaussian-processes.pdf · Wolfram Burgard, Cyrill Stachniss, Kai Arras, Maren Bennewitz

Advanced Topics / Extensions §  Classification/non-Gaussian noise §  Sparse GPs: Approximations for large

data sets §  Heteroscedastic GPs: Modeling non-

constant noise §  Nonstationary GPs: Modeling varying

smoothness (lengthscales) § Mixtures of GPs §  Uncertain inputs §  …

Page 38: Advanced Techniques for Mobile Robotics Gaussian …ais.informatik.uni-freiburg.de/.../pdfs/rob2-14-gaussian-processes.pdf · Wolfram Burgard, Cyrill Stachniss, Kai Arras, Maren Bennewitz

Further Reading

Page 39: Advanced Techniques for Mobile Robotics Gaussian …ais.informatik.uni-freiburg.de/.../pdfs/rob2-14-gaussian-processes.pdf · Wolfram Burgard, Cyrill Stachniss, Kai Arras, Maren Bennewitz

Applications in Robotics § Monocular range sensing §  Terrain modeling §  Learning sensor models §  Learning to control a blimp §  Localization in cellular networks §  Time-series forecasting §  …

Page 40: Advanced Techniques for Mobile Robotics Gaussian …ais.informatik.uni-freiburg.de/.../pdfs/rob2-14-gaussian-processes.pdf · Wolfram Burgard, Cyrill Stachniss, Kai Arras, Maren Bennewitz

Applications in Robotics §  Monocular range sensing §  Terrain modeling §  Learning sensor models §  Learning to control a blimp §  Localization in cellular networks §  Time-series forecasting §  …

Page 41: Advanced Techniques for Mobile Robotics Gaussian …ais.informatik.uni-freiburg.de/.../pdfs/rob2-14-gaussian-processes.pdf · Wolfram Burgard, Cyrill Stachniss, Kai Arras, Maren Bennewitz

Monocular Range Sensing

§  Can we learn range from single, monocular camera images?

Page 42: Advanced Techniques for Mobile Robotics Gaussian …ais.informatik.uni-freiburg.de/.../pdfs/rob2-14-gaussian-processes.pdf · Wolfram Burgard, Cyrill Stachniss, Kai Arras, Maren Bennewitz

Training Setup §  Mobile robot + laser range finder §  Omni-directional monocular camera

Page 43: Advanced Techniques for Mobile Robotics Gaussian …ais.informatik.uni-freiburg.de/.../pdfs/rob2-14-gaussian-processes.pdf · Wolfram Burgard, Cyrill Stachniss, Kai Arras, Maren Bennewitz

Training Setup DFKI Saarbrücken University of Freiburg

Page 44: Advanced Techniques for Mobile Robotics Gaussian …ais.informatik.uni-freiburg.de/.../pdfs/rob2-14-gaussian-processes.pdf · Wolfram Burgard, Cyrill Stachniss, Kai Arras, Maren Bennewitz

Learning Range from Vision §  Associate (polar) pixel columns with ranges

Extract features

Associate with ranges

Page 45: Advanced Techniques for Mobile Robotics Gaussian …ais.informatik.uni-freiburg.de/.../pdfs/rob2-14-gaussian-processes.pdf · Wolfram Burgard, Cyrill Stachniss, Kai Arras, Maren Bennewitz

Pre-processing §  Warp images into a panoramic view

§  120 pixels per column

§  Transform to HSV -> 420 dimensions

Page 46: Advanced Techniques for Mobile Robotics Gaussian …ais.informatik.uni-freiburg.de/.../pdfs/rob2-14-gaussian-processes.pdf · Wolfram Burgard, Cyrill Stachniss, Kai Arras, Maren Bennewitz

Visual Features §  Two types of features

1. No human engineering: Principle components analysis (PCA) on raw input

2. Use of domain specific knowledge: Edge features that shall correspond to floor boundaries

Page 47: Advanced Techniques for Mobile Robotics Gaussian …ais.informatik.uni-freiburg.de/.../pdfs/rob2-14-gaussian-processes.pdf · Wolfram Burgard, Cyrill Stachniss, Kai Arras, Maren Bennewitz

Experiments

Typical 180° scan

Page 48: Advanced Techniques for Mobile Robotics Gaussian …ais.informatik.uni-freiburg.de/.../pdfs/rob2-14-gaussian-processes.pdf · Wolfram Burgard, Cyrill Stachniss, Kai Arras, Maren Bennewitz

Online Prediction

Page 49: Advanced Techniques for Mobile Robotics Gaussian …ais.informatik.uni-freiburg.de/.../pdfs/rob2-14-gaussian-processes.pdf · Wolfram Burgard, Cyrill Stachniss, Kai Arras, Maren Bennewitz

Mapping Results Laser-based Vision-based

Saarbrücken:

Freiburg:

Page 50: Advanced Techniques for Mobile Robotics Gaussian …ais.informatik.uni-freiburg.de/.../pdfs/rob2-14-gaussian-processes.pdf · Wolfram Burgard, Cyrill Stachniss, Kai Arras, Maren Bennewitz

GP-based Terrain Modeling §  3D terrain models are important in

many tasks in outdoor robotics

Page 51: Advanced Techniques for Mobile Robotics Gaussian …ais.informatik.uni-freiburg.de/.../pdfs/rob2-14-gaussian-processes.pdf · Wolfram Burgard, Cyrill Stachniss, Kai Arras, Maren Bennewitz

Terrain Modeling §  Given: observations of the terrain

surface §  Task: Learn a predictive model §  Classic Approach: Elevation grid maps

Page 52: Advanced Techniques for Mobile Robotics Gaussian …ais.informatik.uni-freiburg.de/.../pdfs/rob2-14-gaussian-processes.pdf · Wolfram Burgard, Cyrill Stachniss, Kai Arras, Maren Bennewitz

GP-Based Approach §  Generalize the grid-based model to

fully continuous spaces by viewing the problem as function regression

§  Requirements § Probabilistic formulation to handle

uncertainty § Ability to adapt to the spatial

structures

Page 53: Advanced Techniques for Mobile Robotics Gaussian …ais.informatik.uni-freiburg.de/.../pdfs/rob2-14-gaussian-processes.pdf · Wolfram Burgard, Cyrill Stachniss, Kai Arras, Maren Bennewitz

Covariance Function §  Standard covariance function have

limited flexibility to adapt to the local spatial structure

strong smoothing

medium smoothing

little smoothing

Page 54: Advanced Techniques for Mobile Robotics Gaussian …ais.informatik.uni-freiburg.de/.../pdfs/rob2-14-gaussian-processes.pdf · Wolfram Burgard, Cyrill Stachniss, Kai Arras, Maren Bennewitz

Covariance Function § What is optimal in this case?

Page 55: Advanced Techniques for Mobile Robotics Gaussian …ais.informatik.uni-freiburg.de/.../pdfs/rob2-14-gaussian-processes.pdf · Wolfram Burgard, Cyrill Stachniss, Kai Arras, Maren Bennewitz

Local Kernel Adaptation §  Adapt kernels based on the terrain

gradients §  Covariance is adjusted according to the

change in terrain elevation in the local neighborhood

local average

elevation gradient

Page 56: Advanced Techniques for Mobile Robotics Gaussian …ais.informatik.uni-freiburg.de/.../pdfs/rob2-14-gaussian-processes.pdf · Wolfram Burgard, Cyrill Stachniss, Kai Arras, Maren Bennewitz

Adapting to Local Structures

Ground truth

Stationary GP Non-stationary GP

Page 57: Advanced Techniques for Mobile Robotics Gaussian …ais.informatik.uni-freiburg.de/.../pdfs/rob2-14-gaussian-processes.pdf · Wolfram Burgard, Cyrill Stachniss, Kai Arras, Maren Bennewitz

Adapting to Local Structure §  Model to deal with slowly changing

characteristics and strong discontinuities

Page 58: Advanced Techniques for Mobile Robotics Gaussian …ais.informatik.uni-freiburg.de/.../pdfs/rob2-14-gaussian-processes.pdf · Wolfram Burgard, Cyrill Stachniss, Kai Arras, Maren Bennewitz

Experiments

standard

adaptive

Page 59: Advanced Techniques for Mobile Robotics Gaussian …ais.informatik.uni-freiburg.de/.../pdfs/rob2-14-gaussian-processes.pdf · Wolfram Burgard, Cyrill Stachniss, Kai Arras, Maren Bennewitz

Experiments

Observation (with white noise σ=0.3)

Kernels Predicted Map Local errors

Page 60: Advanced Techniques for Mobile Robotics Gaussian …ais.informatik.uni-freiburg.de/.../pdfs/rob2-14-gaussian-processes.pdf · Wolfram Burgard, Cyrill Stachniss, Kai Arras, Maren Bennewitz

Experiments – Stone Block

Page 61: Advanced Techniques for Mobile Robotics Gaussian …ais.informatik.uni-freiburg.de/.../pdfs/rob2-14-gaussian-processes.pdf · Wolfram Burgard, Cyrill Stachniss, Kai Arras, Maren Bennewitz

Experiments – Stone Block

Ground Truth Observations

Page 62: Advanced Techniques for Mobile Robotics Gaussian …ais.informatik.uni-freiburg.de/.../pdfs/rob2-14-gaussian-processes.pdf · Wolfram Burgard, Cyrill Stachniss, Kai Arras, Maren Bennewitz

Experiments – Stone Block

Prediction

Page 63: Advanced Techniques for Mobile Robotics Gaussian …ais.informatik.uni-freiburg.de/.../pdfs/rob2-14-gaussian-processes.pdf · Wolfram Burgard, Cyrill Stachniss, Kai Arras, Maren Bennewitz

Experiments – Slope

Uncertainties:

Observations & model:

Page 64: Advanced Techniques for Mobile Robotics Gaussian …ais.informatik.uni-freiburg.de/.../pdfs/rob2-14-gaussian-processes.pdf · Wolfram Burgard, Cyrill Stachniss, Kai Arras, Maren Bennewitz

Summary §  GPs are a flexible and practical

approach to Bayesian regression §  Prior knowledge is encoded in a

human understandable way §  Learned models can be interpreted §  Efficiency mainly depends on the

number of training points §  Real-world problem sizes require

approximations/sparsity/…