ΕΚΠ 413 / ΕΚΠ 606 Αυτόνοµοι (Ροµ οτικοί) Πράκτορες

Σχετικά έγγραφα
ΕΚΠ 413 / ΕΚΠ 606 Αυτόνοµοι (Ροµ οτικοί) Πράκτορες

ΕΚΠ 413 / ΕΚΠ 606 Αυτόνοµοι (Ροµ οτικοί) Πράκτορες

Other Test Constructions: Likelihood Ratio & Bayes Tests

Bayesian statistics. DS GA 1002 Probability and Statistics for Data Science.

ΕΙΣΑΓΩΓΗ ΣΤΗ ΣΤΑΤΙΣΤΙΚΗ ΑΝΑΛΥΣΗ

Real time mobile robot control with a multiresolution map representation

ΚΥΠΡΙΑΚΗ ΕΤΑΙΡΕΙΑ ΠΛΗΡΟΦΟΡΙΚΗΣ CYPRUS COMPUTER SOCIETY ΠΑΓΚΥΠΡΙΟΣ ΜΑΘΗΤΙΚΟΣ ΔΙΑΓΩΝΙΣΜΟΣ ΠΛΗΡΟΦΟΡΙΚΗΣ 19/5/2007

TMA4115 Matematikk 3

Approximation of distance between locations on earth given by latitude and longitude

5.4 The Poisson Distribution.

Fourier Series. MATH 211, Calculus II. J. Robert Buchanan. Spring Department of Mathematics

CHAPTER 48 APPLICATIONS OF MATRICES AND DETERMINANTS

Map Generation of Mobile Robot by Probabilistic Observation Model Considering Occlusion

Main source: "Discrete-time systems and computer control" by Α. ΣΚΟΔΡΑΣ ΨΗΦΙΑΚΟΣ ΕΛΕΓΧΟΣ ΔΙΑΛΕΞΗ 4 ΔΙΑΦΑΝΕΙΑ 1

2 Composition. Invertible Mappings

Homework 8 Model Solution Section

Solution Series 9. i=1 x i and i=1 x i.

The Simply Typed Lambda Calculus

ΕΚΠ 413 / ΕΚΠ 606 Αυτόνοµοι (Ροµ οτικοί) Πράκτορες

Aquinas College. Edexcel Mathematical formulae and statistics tables DO NOT WRITE ON THIS BOOKLET

Phys460.nb Solution for the t-dependent Schrodinger s equation How did we find the solution? (not required)

Statistical Inference I Locally most powerful tests

ST5224: Advanced Statistical Theory II

EPL 603 TOPICS IN SOFTWARE ENGINEERING. Lab 5: Component Adaptation Environment (COPE)

EE512: Error Control Coding

Estimation for ARMA Processes with Stable Noise. Matt Calder & Richard A. Davis Colorado State University

Μηχανική Μάθηση Hypothesis Testing

Finite Field Problems: Solutions

Πρόβλημα 1: Αναζήτηση Ελάχιστης/Μέγιστης Τιμής

ECE 468: Digital Image Processing. Lecture 8

Lecture 2. Soundness and completeness of propositional logic

Συστήματα Διαχείρισης Βάσεων Δεδομένων

Probability and Random Processes (Part II)

the total number of electrons passing through the lamp.

Homework 3 Solutions

Reminders: linear functions

Solutions to Exercise Sheet 5

Matrices and Determinants

Bayesian modeling of inseparable space-time variation in disease risk

Parametrized Surfaces

ECE Spring Prof. David R. Jackson ECE Dept. Notes 2

6.1. Dirac Equation. Hamiltonian. Dirac Eq.

Strain gauge and rosettes

Lecture 2: Dirac notation and a review of linear algebra Read Sakurai chapter 1, Baym chatper 3

New bounds for spherical two-distance sets and equiangular lines

Partial Trace and Partial Transpose

3.4 SUM AND DIFFERENCE FORMULAS. NOTE: cos(α+β) cos α + cos β cos(α-β) cos α -cos β

Elements of Information Theory

ΕΛΛΗΝΙΚΗ ΔΗΜΟΚΡΑΤΙΑ ΠΑΝΕΠΙΣΤΗΜΙΟ ΚΡΗΤΗΣ. Ψηφιακή Οικονομία. Διάλεξη 7η: Consumer Behavior Mαρίνα Μπιτσάκη Τμήμα Επιστήμης Υπολογιστών

Jesse Maassen and Mark Lundstrom Purdue University November 25, 2013

Υλοποίηση εντοπισμού στα Nao robots μέσω προσέγγισης του φίλτρου Kalman

Fractional Colorings and Zykov Products of graphs

ΚΥΠΡΙΑΚΗ ΕΤΑΙΡΕΙΑ ΠΛΗΡΟΦΟΡΙΚΗΣ CYPRUS COMPUTER SOCIETY ΠΑΓΚΥΠΡΙΟΣ ΜΑΘΗΤΙΚΟΣ ΔΙΑΓΩΝΙΣΜΟΣ ΠΛΗΡΟΦΟΡΙΚΗΣ 6/5/2006

ΗΜΥ 210 ΣΧΕΔΙΑΣΜΟΣ ΨΗΦΙΑΚΩΝ ΣΥΣΤΗΜΑΤΩΝ. Χειµερινό Εξάµηνο ΔΙΑΛΕΞΗ 3: Αλγοριθµική Ελαχιστοποίηση (Quine-McCluskey, tabular method)

Partial Differential Equations in Biology The boundary element method. March 26, 2013

Problem Set 3: Solutions

Statistics 104: Quantitative Methods for Economics Formula and Theorem Review

Dr. D. Dinev, Department of Structural Mechanics, UACEG

Capacitors - Capacitance, Charge and Potential Difference

SCHOOL OF MATHEMATICAL SCIENCES G11LMA Linear Mathematics Examination Solutions

Υλοποίηση localization στα Nao robots

: Monte Carlo EM 313, Louis (1982) EM, EM Newton-Raphson, /. EM, 2 Monte Carlo EM Newton-Raphson, Monte Carlo EM, Monte Carlo EM, /. 3, Monte Carlo EM

Areas and Lengths in Polar Coordinates

Inverse trigonometric functions & General Solution of Trigonometric Equations

ΚΥΠΡΙΑΚΟΣ ΣΥΝΔΕΣΜΟΣ ΠΛΗΡΟΦΟΡΙΚΗΣ CYPRUS COMPUTER SOCIETY 21 ος ΠΑΓΚΥΠΡΙΟΣ ΜΑΘΗΤΙΚΟΣ ΔΙΑΓΩΝΙΣΜΟΣ ΠΛΗΡΟΦΟΡΙΚΗΣ Δεύτερος Γύρος - 30 Μαρτίου 2011

Overview. Transition Semantics. Configurations and the transition relation. Executions and computation

Chapter 6: Systems of Linear Differential. be continuous functions on the interval

Math221: HW# 1 solutions

A Bonus-Malus System as a Markov Set-Chain. Małgorzata Niemiec Warsaw School of Economics Institute of Econometrics

Econ 2110: Fall 2008 Suggested Solutions to Problem Set 8 questions or comments to Dan Fetter 1

SCITECH Volume 13, Issue 2 RESEARCH ORGANISATION Published online: March 29, 2018

Numerical Analysis FMN011

b. Use the parametrization from (a) to compute the area of S a as S a ds. Be sure to substitute for ds!

Instruction Execution Times

P AND P. P : actual probability. P : risk neutral probability. Realtionship: mutual absolute continuity P P. For example:

Discontinuous Hermite Collocation and Diagonally Implicit RK3 for a Brain Tumour Invasion Model

Section 9.2 Polar Equations and Graphs

Volume of a Cuboid. Volume = length x breadth x height. V = l x b x h. The formula for the volume of a cuboid is

Areas and Lengths in Polar Coordinates

Module 5. February 14, h 0min

Repeated measures Επαναληπτικές μετρήσεις

Example Sheet 3 Solutions

Block Ciphers Modes. Ramki Thurimella

Spherical Coordinates

A Lambda Model Characterizing Computational Behaviours of Terms

Σχέσεις, Ιδιότητες, Κλειστότητες

Αξιολόγηση των Φασματικού Διαχωρισμού στην Διάκριση Διαφορετικών Τύπων Εδάφους ΔΙΠΛΩΜΑΤΙΚΗ ΕΡΓΑΣΙΑ. Σπίγγος Γεώργιος

Variational Wavefunction for the Helium Atom

Section 8.3 Trigonometric Equations

Asymptotic distribution of MLE

Τελική Εξέταση =1 = 0. a b c. Τµήµα Ηλεκτρολόγων Μηχανικών και Μηχανικών Υπολογιστών. HMY 626 Επεξεργασία Εικόνας

L-SLAM: Μείωση διαστάσεων στην οικογένεια αλγορίθµων FastSLAM

Aluminum Electrolytic Capacitors (Large Can Type)

Homework for 1/27 Due 2/5

Supplementary Material for The Cusp Catastrophe Model as Cross-Sectional and Longitudinal Mixture Structural Equation Models

Αλγόριθμοι και πολυπλοκότητα NP-Completeness (2)

Lecture 34 Bootstrap confidence intervals

Εξερεύνηση χώρου από κινούμενα ρομπότ

Buried Markov Model Pairwise

Transcript:

ΕΚΠ 413 / ΕΚΠ 606 Αυτόνοµοι (Ροµ οτικοί) Πράκτορες Ροµ οτική Χαρτογράφηη Robotic Mapping Τµήµα Ηλεκτρονικών Μηχανικών και Μηχανικών Υ ολογιτών Πολυτεχνείο Κρήτης

Ε ανάληψη Στρατηγικές MaxiMin παιχνίδια µηδενικού αθροίµατος αλγόριθµος µαθηµατικού προγραµµατιµού Παιχνίδια µη µηδενικού αθροίµατος επαναλαµβανόµενα Μαρκωβιανά αιχνίδια µοντελοποίηη χεδιαµός µάθηη Μ. Γ. Λαγουδάκης Τµήµα ΗΜΜΥ Πολυτεχνείο Κρήτης Σελίδα 2

Robot Navigation Problems What should I remember? Mapping Where am I? Localization Where should I go? Path Planning How can I go? Motion Control Μ. Γ. Λαγουδάκης Τµήµα ΗΜΜΥ Πολυτεχνείο Κρήτης Σελίδα 3

Σήµερα Mapping problem definition considerations Occupancy Grid Mapping known robot poses occupancy grid update SLAM unknown robot poses online SLAM full SLAM Μ. Γ. Λαγουδάκης Τµήµα ΗΜΜΥ Πολυτεχνείο Κρήτης Σελίδα 4

Mapping What should I remember?

Mapping and Localization Localization estimate the robot s pose at each time step easy, when a map of the surrounding environment is known Mapping construct a map of the robot s surrounding environment easy, when the robot s pose is known at each time step Simultaneous Localization and Mapping (SLAM) robot s pose and map are both unknown simultaneously, estimate robot s pose and construct a map Μ. Γ. Λαγουδάκης Τµήµα ΗΜΜΥ Πολυτεχνείο Κρήτης Σελίδα 6

Mapping Factors Size size of the environment relative to robot s perceptual range number of distinct landmarks in the environment Noise noise in perception (reflections, variable illumination) noise in actuation (variable friction, inaccurate odometry) Ambiguity perceptual aliasing (different places appear to be the same) Structure straight corridors are easy, cycles or loops can be really hard correspondence of landmarks Μ. Γ. Λαγουδάκης Τµήµα ΗΜΜΥ Πολυτεχνείο Κρήτης Σελίδα 7

Desired Mapping Result Μ. Γ. Λαγουδάκης Τµήµα ΗΜΜΥ Πολυτεχνείο Κρήτης Σελίδα 8

Mapping with Odometry Μ. Γ. Λαγουδάκης Τµήµα ΗΜΜΥ Πολυτεχνείο Κρήτης Σελίδα 9

Types of Mapping Problems Grid-based maps [Lu & Milios, 97; Gutmann, 98: Thrun 98; Burgard, 99; Konolige & Gutmann, 00; Thrun, 00; Arras, 99; Haehnel, 01; ] Landmark-based maps [Leonard et al., 98; Castelanos et al., 99: Dissanayake et al., 2001; Montemerlo et al., 2002; ] Μ. Γ. Λαγουδάκης Τµήµα ΗΜΜΥ Πολυτεχνείο Κρήτης Σελίδα 10

Occupancy Grid Mapping Mapping with Known Poses

Occupancy Grid Mapping Assumptions the true robot pose is known perception consists of range measurements Occupancy Grid introduced by Moravec and Elfes in 1985 representation as a field of random variables each variable corresponds to a unique small area (cell) variables arranged in an evenly spaced grid binary variables (free space or obstacle) Algorithm approximate posterior estimation for all random variables probability that each cell is occupied or not Μ. Γ. Λαγουδάκης Τµήµα ΗΜΜΥ Πολυτεχνείο Κρήτης Σελίδα 12

Problem Definition d = { x, z, x, z,, x, z } 1 1 2 2 n n m * = arg max P( m d ) m Μ. Γ. Λαγουδάκης Τµήµα ΗΜΜΥ Πολυτεχνείο Κρήτης Σελίδα 13

Considerations Complexity 100 x 100 grid 10000 cells 2 10000 possible maps intractable to calculate the posterior for each map Assumptions map is static m = m t for all t each cell in independent from all others 100 x 100 grid 10000 binary estimation problems ignores the dependencies between neighboring cells [ xy ] ( ) (,,, ) ( ) 1 1 Bel m P m x z x z Bel m = = t t x, y Μ. Γ. Λαγουδάκης Τµήµα ΗΜΜΥ Πολυτεχνείο Κρήτης Σελίδα 14

Occupancy Grid Mapping Algorithm Bayesian Filter Bel( m ) = η p( z m ) Bel( m [ xy] [ xy] [ xy] t t t t 1 ) Μ. Γ. Λαγουδάκης Τµήµα ΗΜΜΥ Πολυτεχνείο Κρήτης Σελίδα 15

Log-Odds Representation ( ) B m xy xy : = log odds( m ) [ ] [ ] t odds x P ( x ) ( x ) ( ) : = 1 P t ( ) = log (, ) [ xy ] [ xy ] B m odds m z x t t t t ( ) [ ] 1 xy +B mt log odds m t ( ) xy [ ] Μ. Γ. Λαγουδάκης Τµήµα ΗΜΜΥ Πολυτεχνείο Κρήτης Σελίδα 16

Simple Inverse Sensor Models Μ. Γ. Λαγουδάκης Τµήµα ΗΜΜΥ Πολυτεχνείο Κρήτης Σελίδα 17

Inverse Sensor Model Algorithm Μ. Γ. Λαγουδάκης Τµήµα ΗΜΜΥ Πολυτεχνείο Κρήτης Σελίδα 18

Modern Sensor Models Μ. Γ. Λαγουδάκης Τµήµα ΗΜΜΥ Πολυτεχνείο Κρήτης Σελίδα 19

Occupancy Grid Example Μ. Γ. Λαγουδάκης Τµήµα ΗΜΜΥ Πολυτεχνείο Κρήτης Σελίδα 20

Potential Problems Μ. Γ. Λαγουδάκης Τµήµα ΗΜΜΥ Πολυτεχνείο Κρήτης Σελίδα 21

Example: Tech Museum, San Jose CAD map occupancy grid map Μ. Γ. Λαγουδάκης Τµήµα ΗΜΜΥ Πολυτεχνείο Κρήτης Σελίδα 22

Simultaneous Localization and Mapping Mapping with Unknown Poses

The SLAM Problem Given robot s controls robot s observations Estimate map of the environment robot s pose at each time step Assumptions static environment, noisy controls and observations Representation landmark-based grid-based Μ. Γ. Λαγουδάκης Τµήµα ΗΜΜΥ Πολυτεχνείο Κρήτης Σελίδα 24

SLAM Problems Full SLAM Estimates entire path and map! p( x, m z, u : t 1: t 1: 1 t ) Online SLAM p ( x, m z, u ) = p( x, m z, u ) dx dx... dx t 1: t 1: t 1: t 1: t 1: t 1 2 t 1 Integrations typically done one at a time Estimates most recent pose and map! Μ. Γ. Λαγουδάκης Τµήµα ΗΜΜΥ Πολυτεχνείο Κρήτης Σελίδα 25

Online SLAM p ( x, m z, u ) = p( x, m z, u ) dx dx... dx t 1: t 1: t 1: t 1: t 1: t 1 2 t 1 Μ. Γ. Λαγουδάκης Τµήµα ΗΜΜΥ Πολυτεχνείο Κρήτης Σελίδα 26

Full SLAM p( x, m z, u : t 1: t 1: 1 t ) Μ. Γ. Λαγουδάκης Τµήµα ΗΜΜΥ Πολυτεχνείο Κρήτης Σελίδα 27

Nature of SLAM Continuous estimation robot s pose location of objects points in the continuous space Discrete estimation landmarks or object patches object correspondence relationship to previously recognized objects either the same, or different Problems high dimensionality + large number of correspondences Μ. Γ. Λαγουδάκης Τµήµα ΗΜΜΥ Πολυτεχνείο Κρήτης Σελίδα 28

Mapping as Localization Idea mapping is like localization, but in a much larger space find the most possible (x t,m) instead of just (x t ) dimensionality: dimensions of robot pose + dimensions of map use any localization algorithm: Markov, Grid, Gaussian, Monte-Carlo Localization Bel x ) = P( x u, z, u, z ) ( t t 1 1 t t Bel ( x ) Pη ( Px zu 1, xz ) 1 P, u( x, z ) u, x ) t t t t t t t t t Mapping Bel ( x, m) = P( x, m u, z, u, z ) = Bel x dxt = ( ( ) 1 t 1 1 1 1 t t t t Bel ( x, m) P( z x, m) P( x, m u, x, m) Bel ( x, m) dx dm = η 1 1 1 t t t t t t t t Μ. Γ. Λαγουδάκης Τµήµα ΗΜΜΥ Πολυτεχνείο Κρήτης Σελίδα 29

Μ. Γ. Λαγουδάκης Τµήµα ΗΜΜΥ Πολυτεχνείο Κρήτης Σελίδα 30 map with n landmarks:(3+2n)-dimensional Gaussian tracking with an extended Kalman filter can handle a few hundreds of dimensions = 2 2 2 2 2 2 2 1 2 1 2 2 1 2 2 2 2 1 1 2 1 1 1 1 2 1 2 1 2 1, ), ( N N N N N N N N N N N l l l l l l yl xl l l l l l l yl xl l l l l l l yl xl l l l y x yl yl yl y y xy xl xl xl x xy x N t t l l l y x m Belx θ θ θ θ θ θ θ θ θ θ θ θ (E)KF-SLAM

Example: EKF-SLAM Map Correlation matrix Μ. Γ. Λαγουδάκης Τµήµα ΗΜΜΥ Πολυτεχνείο Κρήτης Σελίδα 31

Example: EKF-SLAM Map Correlation matrix Μ. Γ. Λαγουδάκης Τµήµα ΗΜΜΥ Πολυτεχνείο Κρήτης Σελίδα 32

Example: EKF-SLAM Map Correlation matrix Μ. Γ. Λαγουδάκης Τµήµα ΗΜΜΥ Πολυτεχνείο Κρήτης Σελίδα 33

Example: KF-SLAM Μ. Γ. Λαγουδάκης Τµήµα ΗΜΜΥ Πολυτεχνείο Κρήτης Σελίδα 34

Μελέτη Σύγγραµµα Ενότητα 25.3 Βιβλία S. Thrun, W. Burgard, and D. Fox, Probabilistic Robotics, MIT Press 2005, Ch. 9, 10. Μ. Γ. Λαγουδάκης Τµήµα ΗΜΜΥ Πολυτεχνείο Κρήτης Σελίδα 35