Robot Mapping. A Short Introduction to the Bayes Filter and Related Models. Gian Diego Tipaldi, Wolfram Burgard

Similar documents
Practical Course WS12/13 Introduction to Monte Carlo Localization

Robot Mapping. Grid Maps. Gian Diego Tipaldi, Wolfram Burgard

Robot Mapping. A Short Introduction to Homogeneous Coordinates. Gian Diego Tipaldi, Wolfram Burgard

Humanoid Robotics. Monte Carlo Localization. Maren Bennewitz

Robot Mapping. Hierarchical Pose-Graphs for Online Mapping. Gian Diego Tipaldi, Wolfram Burgard

ICRA 2016 Tutorial on SLAM. Graph-Based SLAM and Sparsity. Cyrill Stachniss

Particle Filter in Brief. Robot Mapping. FastSLAM Feature-based SLAM with Particle Filters. Particle Representation. Particle Filter Algorithm

L10. PARTICLE FILTERING CONTINUED. NA568 Mobile Robotics: Methods & Algorithms

Spring Localization II. Roland Siegwart, Margarita Chli, Juan Nieto, Nick Lawrance. ASL Autonomous Systems Lab. Autonomous Mobile Robots

L17. OCCUPANCY MAPS. NA568 Mobile Robotics: Methods & Algorithms

COS Lecture 13 Autonomous Robot Navigation

Probabilistic Robotics

Introduction to Mobile Robotics SLAM Landmark-based FastSLAM

Probabilistic Robotics

Probabilistic Robotics

Spring Localization II. Roland Siegwart, Margarita Chli, Martin Rufli. ASL Autonomous Systems Lab. Autonomous Mobile Robots

Autonomous Mobile Robot Design

Simultaneous Localization and Mapping

Localization, Mapping and Exploration with Multiple Robots. Dr. Daisy Tang

Introduction to Mobile Robotics Probabilistic Motion Models

Probabilistic Robotics

Localization and Map Building

Introduction to Mobile Robotics SLAM Grid-based FastSLAM. Wolfram Burgard, Cyrill Stachniss, Maren Bennewitz, Diego Tipaldi, Luciano Spinello

Probabilistic Robotics

Introduction to Mobile Robotics Bayes Filter Particle Filter and Monte Carlo Localization. Wolfram Burgard

IROS 05 Tutorial. MCL: Global Localization (Sonar) Monte-Carlo Localization. Particle Filters. Rao-Blackwellized Particle Filters and Loop Closing

Overview. EECS 124, UC Berkeley, Spring 2008 Lecture 23: Localization and Mapping. Statistical Models

This chapter explains two techniques which are frequently used throughout

Robot Mapping. Least Squares Approach to SLAM. Cyrill Stachniss

Graphbased. Kalman filter. Particle filter. Three Main SLAM Paradigms. Robot Mapping. Least Squares Approach to SLAM. Least Squares in General

Final Exam Practice Fall Semester, 2012

Localization and Map Building

EE565:Mobile Robotics Lecture 3

Particle Filters. CSE-571 Probabilistic Robotics. Dependencies. Particle Filter Algorithm. Fast-SLAM Mapping

Introduction to Mobile Robotics

Advanced Techniques for Mobile Robotics Graph-based SLAM using Least Squares. Wolfram Burgard, Cyrill Stachniss, Kai Arras, Maren Bennewitz

Visual Bearing-Only Simultaneous Localization and Mapping with Improved Feature Matching

Probabilistic Robotics. FastSLAM

CSE 490R P1 - Localization using Particle Filters Due date: Sun, Jan 28-11:59 PM

AUTONOMOUS SYSTEMS. LOCALIZATION, MAPPING & SIMULTANEOUS LOCALIZATION AND MAPPING Part V Mapping & Occupancy Grid Mapping

Monte Carlo Localization using Dynamically Expanding Occupancy Grids. Karan M. Gupta

7630 Autonomous Robotics Probabilities for Robotics

EKF Localization and EKF SLAM incorporating prior information

PacSLAM Arunkumar Byravan, Tanner Schmidt, Erzhuo Wang

L15. POSE-GRAPH SLAM. NA568 Mobile Robotics: Methods & Algorithms

Basics of Localization, Mapping and SLAM. Jari Saarinen Aalto University Department of Automation and systems Technology

SLAM: Robotic Simultaneous Location and Mapping

Monte Carlo Localization for Mobile Robots

Grid-Based Models for Dynamic Environments

Robotics. Chapter 25. Chapter 25 1

Markov Localization for Mobile Robots in Dynaic Environments

What is the SLAM problem?

Revising Stereo Vision Maps in Particle Filter Based SLAM using Localisation Confidence and Sample History

Robot Mapping. Graph-Based SLAM with Landmarks. Cyrill Stachniss

Probabilistic Matching for 3D Scan Registration

Practical Course WS 2010 Simultaneous Localization and Mapping

AUTONOMOUS SYSTEMS. PROBABILISTIC LOCALIZATION Monte Carlo Localization

Computer Vision Group Prof. Daniel Cremers. 11. Sampling Methods

Localization, Where am I?

Jurnal Teknologi PARTICLE FILTER IN SIMULTANEOUS LOCALIZATION AND MAPPING (SLAM) USING DIFFERENTIAL DRIVE MOBILE ROBOT. Full Paper

Robust Monte-Carlo Localization using Adaptive Likelihood Models

Statistical Techniques in Robotics (16-831, F10) Lecture#06(Thursday September 11) Occupancy Maps

Final project: 45% of the grade, 10% presentation, 35% write-up. Presentations: in lecture Dec 1 and schedule:

Navigation methods and systems

Announcements. Recap Landmark based SLAM. Types of SLAM-Problems. Occupancy Grid Maps. Grid-based SLAM. Page 1. CS 287: Advanced Robotics Fall 2009

Robot Mapping. TORO Gradient Descent for SLAM. Cyrill Stachniss

Statistical Techniques in Robotics (16-831, F12) Lecture#05 (Wednesday, September 12) Mapping

Robot Mapping. Graph-Based SLAM with Landmarks. Cyrill Stachniss

CSE-571 Robotics. Sensors for Mobile Robots. Beam-based Sensor Model. Proximity Sensors. Probabilistic Sensor Models. Beam-based Scan-based Landmarks

ECE276A: Sensing & Estimation in Robotics Lecture 11: Simultaneous Localization and Mapping using a Particle Filter

Monte Carlo Localization

Where s the Boss? : Monte Carlo Localization for an Autonomous Ground Vehicle using an Aerial Lidar Map

Particle Filter Localization

Introduction to Mobile Robotics Techniques for 3D Mapping

Implementation of Odometry with EKF for Localization of Hector SLAM Method

CVPR 2014 Visual SLAM Tutorial Efficient Inference

RoboCup Rescue Summer School Navigation Tutorial

A New Omnidirectional Vision Sensor for Monte-Carlo Localization

Efficient Failure Detection for Mobile Robots Using Mixed-Abstraction Particle Filters

Statistical Techniques in Robotics (STR, S15) Lecture#05 (Monday, January 26) Lecturer: Byron Boots

Introduction to Multi-Agent Programming

Scan Matching. Pieter Abbeel UC Berkeley EECS. Many slides adapted from Thrun, Burgard and Fox, Probabilistic Robotics

USING 3D DATA FOR MONTE CARLO LOCALIZATION IN COMPLEX INDOOR ENVIRONMENTS. Oliver Wulf, Bernardo Wagner

Introduction to robot algorithms CSE 410/510

Tracking Multiple Moving Objects with a Mobile Robot

Robotic Mapping. Outline. Introduction (Tom)

Fox, Burgard & Thrun problem they attack. Tracking or local techniques aim at compensating odometric errors occurring during robot navigation. They re

Localization of Multiple Robots with Simple Sensors

Robust Monte Carlo Localization for Mobile Robots

Obstacle Avoidance (Local Path Planning)

Today MAPS AND MAPPING. Features. process of creating maps. More likely features are things that can be extracted from images:

UNIVERSITÀ DEGLI STUDI DI GENOVA MASTER S THESIS

Mobile Robot Mapping and Localization in Non-Static Environments

Adapting Navigation Strategies Using Motions Patterns of People

Zürich. Roland Siegwart Margarita Chli Martin Rufli Davide Scaramuzza. ETH Master Course: L Autonomous Mobile Robots Summary

CAMERA POSE ESTIMATION OF RGB-D SENSORS USING PARTICLE FILTERING

Mobile Robotics. Mathematics, Models, and Methods. HI Cambridge. Alonzo Kelly. Carnegie Mellon University UNIVERSITY PRESS

Humanoid Robotics. Least Squares. Maren Bennewitz

ME 456: Probabilistic Robotics

Robotics. Lecture 5: Monte Carlo Localisation. See course website for up to date information.

Transcription:

Robot Mapping A Short Introduction to the Bayes Filter and Related Models Gian Diego Tipaldi, Wolfram Burgard 1

State Estimation Estimate the state of a system given observations and controls Goal: 2

Recursive Bayes Filter 1 Definition of the belief 3

Recursive Bayes Filter 2 Bayes rule 4

Recursive Bayes Filter 3 Markov assumption 5

Recursive Bayes Filter 4 Law of total probability 6

Recursive Bayes Filter 5 Markov assumption 7

Recursive Bayes Filter 6 Markov assumption 8

Recursive Bayes Filter 7 Recursive term 9

Prediction and Correction Step Bayes filter can be written as a two step process Prediction step Correction step 10

Motion and Observation Model Prediction step motion model Correction step sensor or observation model 11

Different Realizations The Bayes filter is a framework for recursive state estimation There are different realizations Different properties Linear vs. non-linear models for motion and observation models Gaussian distributions only? Parametric vs. non-parametric filters 12

In this Course Kalman filter & friends Gaussians Linear or linearized models Particle filter Non-parametric Arbitrary models (sampling required) 13

Motion Model 14

Robot Motion Models Robot motion is inherently uncertain How can we model this uncertainty? Courtesy: Thrun, Burgard, Fox 15

Probabilistic Motion Models Specifies a posterior probability that action u carries the robot from x to x. 16

Typical Motion Models In practice, one often finds two types of motion models: Odometry-based Velocity-based Odometry-based models for systems that are equipped with wheel encoders Velocity-based when no wheel encoders are available 17

Odometry Model Robot moves from to. Odometry information 18

Probability Distribution Noise in odometry Example: Gaussian noise 19

Examples (Odometry-Based) Courtesy: Thrun, Burgard, Fox 20

Velocity-Based Model -90 Courtesy: Thrun, Burgard, Fox 21

Motion Equation Robot moves from to. Velocity information 22

Problem of the Velocity-Based Model Robot moves on a circle The circle constrains the final orientation Fix: introduce an additional noise term on the final orientation 23

Motion Including 3 rd Parameter Term to account for the final rotation 24

Examples (Velocity-Based) Courtesy: Thrun, Burgard, Fox 25

Sensor Model 26

Model for Laser Scanners Scan z consists of K measurements. Individual measurements are independent given the robot position 27

Beam-Endpoint Model Courtesy: Thrun, Burgard, Fox 28

Beam-Endpoint Model map likelihood field Courtesy: N. Roy 29

Ray-cast Model Ray-cast model considers the first obstacle long the line of sight Mixture of four models 30

Model for Perceiving Landmarks with Range-Bearing Sensors Range-bearing Robot s pose Observation of feature j at location 31

Summary Bayes filter is a framework for state estimation Motion and sensor model are the central models in the Bayes filter Standard models for robot motion and laser-based range sensing 32

Literature On the Bayes filter Thrun et al. Probabilistic Robotics, Chapter 2 Course: Introduction to Mobile Robotics, Chapter 5 On motion and observation models Thrun et al. Probabilistic Robotics, Chapters 5 & 6 Course: Introduction to Mobile Robotics, Chapters 6 & 7 33

Slide Information These slides have been created by Cyrill Stachniss as part of the robot mapping course taught in 2012/13 and 2013/14. I created this set of slides partially extending existing material of Edwin Olson, Pratik Agarwal, and myself. I tried to acknowledge all people that contributed image or video material. In case I missed something, please let me know. If you adapt this course material, please make sure you keep the acknowledgements. Feel free to use and change the slides. If you use them, I would appreciate an acknowledgement as well. To satisfy my own curiosity, I appreciate a short email notice in case you use the material in your course. My video recordings are available through YouTube: http://www.youtube.com/playlist?list=plgnqpqtftogqrz4o5qzbihgl3b1jhimn_&feature=g-list Cyrill Stachniss, 2014 cyrill.stachniss@igg.uni- 34