+ All Categories
Home > Documents > Advanced Techniques for Mobile Robotics Gaussian...

Advanced Techniques for Mobile Robotics Gaussian...

Date post: 07-Aug-2019
Category:
Upload: hatu
View: 214 times
Download: 0 times
Share this document with a friend
64
Wolfram Burgard, Cyrill Stachniss, Kai Arras, Maren Bennewitz Gaussian Processes in Robotics Advanced Techniques for Mobile Robotics
Transcript
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/…


Recommended