Top Banner
Probabilistic Fundamentals Probabilistic Fundamentals in Robotics in Robotics in Robotics in Robotics Basic Concepts in Probability Basic Concepts in Probability Basilio Bona DAUIN – Politecnico di Torino July 2010
42

Probabilistic Fundamentals in Robotics - polito.it · Probabilistic Fundamentals in Robotics Basic Concepts in Probability Basilio Bona DAUIN – Politecnico di Torino July 2010.

Oct 20, 2019

Download

Documents

dariahiddleston
Welcome message from author
This document is posted to help you gain knowledge. Please leave a comment to let me know what you think about it! Share it to your friends and learn new things together.
Transcript
Page 1: Probabilistic Fundamentals in Robotics - polito.it · Probabilistic Fundamentals in Robotics Basic Concepts in Probability Basilio Bona DAUIN – Politecnico di Torino July 2010.

Probabilistic FundamentalsProbabilistic Fundamentalsin Roboticsin Roboticsin Roboticsin Robotics

Basic Concepts in ProbabilityBasic Concepts in Probability

Basilio Bonaasilio onaDAUIN – Politecnico di Torino

July 2010

Page 2: Probabilistic Fundamentals in Robotics - polito.it · Probabilistic Fundamentals in Robotics Basic Concepts in Probability Basilio Bona DAUIN – Politecnico di Torino July 2010.

Course Outline

Motivations

Basic mathematical frameworkBasic mathematical framework

Probabilistic models of mobile robots

Mobile robot localization problem

Robotic mapping

Probabilistic planning and control

Reference textbook [TBF2006]

Thrun Burgard Fox “Probabilistic Robotics” MIT PressThrun, Burgard, Fox,  Probabilistic Robotics , MIT Press, 2006

http://www probabilistic‐robotics org/http://www.probabilistic‐robotics.org/

Basilio Bona July 2010 2

Page 3: Probabilistic Fundamentals in Robotics - polito.it · Probabilistic Fundamentals in Robotics Basic Concepts in Probability Basilio Bona DAUIN – Politecnico di Torino July 2010.

Basic mathematical framework

Basic concepts in probabilityRecursive state estimationRecursive state estimation– Robot environment– Bayes filtersBayes filters

Gaussian filters– Kalman filterKalman filter– Extended Kalman Filter– Unscented Kalman filter– Information filter

Nonparametric filtersp– Histogram filter– Particle filter

Basilio Bona July 2010 3

Page 4: Probabilistic Fundamentals in Robotics - polito.it · Probabilistic Fundamentals in Robotics Basic Concepts in Probability Basilio Bona DAUIN – Politecnico di Torino July 2010.

Basic concepts in probability

In binary logic, a proposition about the state of the world is only True or False; no third hypothesis is consideredis only True or False; no third hypothesis is considered

Bayesian probability is a measure of the degree of belief of a proposition or an objective degree of rationalbelief of a proposition, or an objective degree of rational belief, given the evidence

Basilio Bona July 2010 4

Page 5: Probabilistic Fundamentals in Robotics - polito.it · Probabilistic Fundamentals in Robotics Basic Concepts in Probability Basilio Bona DAUIN – Politecnico di Torino July 2010.

Other axioms

True

A BA B

A∩B

Basilio Bona July 2010 5

Page 6: Probabilistic Fundamentals in Robotics - polito.it · Probabilistic Fundamentals in Robotics Basic Concepts in Probability Basilio Bona DAUIN – Politecnico di Torino July 2010.

Random variables

( )P x

Basilio Bona July 2010 6

x

Page 7: Probabilistic Fundamentals in Robotics - polito.it · Probabilistic Fundamentals in Robotics Basic Concepts in Probability Basilio Bona DAUIN – Politecnico di Torino July 2010.

Continuous random variables

( )( )p x

xa b

Pr( )x

Basilio Bona July 2010 7

a b

Page 8: Probabilistic Fundamentals in Robotics - polito.it · Probabilistic Fundamentals in Robotics Basic Concepts in Probability Basilio Bona DAUIN – Politecnico di Torino July 2010.

Univariate Gaussian distribution

Basilio Bona July 2010 8

Page 9: Probabilistic Fundamentals in Robotics - polito.it · Probabilistic Fundamentals in Robotics Basic Concepts in Probability Basilio Bona DAUIN – Politecnico di Torino July 2010.

Normal distribution

Basilio Bona July 2010 9

Page 10: Probabilistic Fundamentals in Robotics - polito.it · Probabilistic Fundamentals in Robotics Basic Concepts in Probability Basilio Bona DAUIN – Politecnico di Torino July 2010.

Normal distribution

Basilio Bona July 2010 10

Page 11: Probabilistic Fundamentals in Robotics - polito.it · Probabilistic Fundamentals in Robotics Basic Concepts in Probability Basilio Bona DAUIN – Politecnico di Torino July 2010.

Multi‐variate Gaussian distribution

Mean vectorCovariance matrix Mean vectorCovariance matrix

Basilio Bona July 2010 11

Page 12: Probabilistic Fundamentals in Robotics - polito.it · Probabilistic Fundamentals in Robotics Basic Concepts in Probability Basilio Bona DAUIN – Politecnico di Torino July 2010.

Joint and conditional probabilities

Basilio Bona July 2010 12

Page 13: Probabilistic Fundamentals in Robotics - polito.it · Probabilistic Fundamentals in Robotics Basic Concepts in Probability Basilio Bona DAUIN – Politecnico di Torino July 2010.

Marginal and total Probability

Di tDiscrete

Continuous

Basilio Bona July 2010 13

Page 14: Probabilistic Fundamentals in Robotics - polito.it · Probabilistic Fundamentals in Robotics Basic Concepts in Probability Basilio Bona DAUIN – Politecnico di Torino July 2010.

Posterior probability and Bayes rule

Prior probability distribution

Posterior probability distribution

Basilio Bona July 2010 14

Page 15: Probabilistic Fundamentals in Robotics - polito.it · Probabilistic Fundamentals in Robotics Basic Concepts in Probability Basilio Bona DAUIN – Politecnico di Torino July 2010.

Bayes rule conditioned by another variable

Basilio Bona July 2010 15

Page 16: Probabilistic Fundamentals in Robotics - polito.it · Probabilistic Fundamentals in Robotics Basic Concepts in Probability Basilio Bona DAUIN – Politecnico di Torino July 2010.

Normalization

Basilio Bona July 2010 16

Page 17: Probabilistic Fundamentals in Robotics - polito.it · Probabilistic Fundamentals in Robotics Basic Concepts in Probability Basilio Bona DAUIN – Politecnico di Torino July 2010.

Marginal probability

Marginal probability

Basilio Bona July 2010 17

Page 18: Probabilistic Fundamentals in Robotics - polito.it · Probabilistic Fundamentals in Robotics Basic Concepts in Probability Basilio Bona DAUIN – Politecnico di Torino July 2010.

Conditional independence

This is an important rule in probabilistic robotics. It applies whenever a variable y carries no information

Basilio Bona July 2010 18

about a variable x, if the value z of another variable is known

Page 19: Probabilistic Fundamentals in Robotics - polito.it · Probabilistic Fundamentals in Robotics Basic Concepts in Probability Basilio Bona DAUIN – Politecnico di Torino July 2010.

Conditional independence ≠ absolute independence

conditional independenceconditional independence

andand

absolute independenceabsolute independence

Basilio Bona July 2010 19

Page 20: Probabilistic Fundamentals in Robotics - polito.it · Probabilistic Fundamentals in Robotics Basic Concepts in Probability Basilio Bona DAUIN – Politecnico di Torino July 2010.

Expectation of a random variable

Features of probabilistic distributions are called statisticsstatistics

Expectation of a random variable (RV) X is defined asExpectation of a random variable (RV) X is defined as 

Basilio Bona July 2010 20

Page 21: Probabilistic Fundamentals in Robotics - polito.it · Probabilistic Fundamentals in Robotics Basic Concepts in Probability Basilio Bona DAUIN – Politecnico di Torino July 2010.

Covariance

Covariancemeasures the squared expected deviation from the mean

Basilio Bona July 2010 21

Page 22: Probabilistic Fundamentals in Robotics - polito.it · Probabilistic Fundamentals in Robotics Basic Concepts in Probability Basilio Bona DAUIN – Politecnico di Torino July 2010.

Entropy

Entropymeasures the expected information that the value of x carriesvalue of x carries

In discrete case is the number of bits required to encode x

Basilio Bona July 2010 22

In discrete case is the number of bits required to encode xusing an optimal encoding, assuming that p(x) is the probability of observing x

Page 23: Probabilistic Fundamentals in Robotics - polito.it · Probabilistic Fundamentals in Robotics Basic Concepts in Probability Basilio Bona DAUIN – Politecnico di Torino July 2010.

Robot environment interaction

LOCALIZATIONLOCALIZATION PLANNINGPLANNING

PERCEPTIONPERCEPTION ACTIONACTION

E i tE i t

Basilio Bona July 2010 23

EnvironmentEnvironment

Page 24: Probabilistic Fundamentals in Robotics - polito.it · Probabilistic Fundamentals in Robotics Basic Concepts in Probability Basilio Bona DAUIN – Politecnico di Torino July 2010.

Robot environment interaction

World or environment is a dynamical system that has an internal stateinternal state

Robot sensors can acquire information about the world internal stateinternal state

Sensors are noisy and often complete information cannot b i dbe acquired

A beliefmeasure about the state of the world is stored by the robot

Robot influences the world through its actuators (e.g., they make it move in the environment)

Basilio Bona July 2010 24

Page 25: Probabilistic Fundamentals in Robotics - polito.it · Probabilistic Fundamentals in Robotics Basic Concepts in Probability Basilio Bona DAUIN – Politecnico di Torino July 2010.

State

Basilio Bona July 2010 25

Page 26: Probabilistic Fundamentals in Robotics - polito.it · Probabilistic Fundamentals in Robotics Basic Concepts in Probability Basilio Bona DAUIN – Politecnico di Torino July 2010.

Complete state

Basilio Bona July 2010 26

Page 27: Probabilistic Fundamentals in Robotics - polito.it · Probabilistic Fundamentals in Robotics Basic Concepts in Probability Basilio Bona DAUIN – Politecnico di Torino July 2010.

Stochastic process

Basilio Bona July 2010 27

Page 28: Probabilistic Fundamentals in Robotics - polito.it · Probabilistic Fundamentals in Robotics Basic Concepts in Probability Basilio Bona DAUIN – Politecnico di Torino July 2010.

Markov chains

a Markov chain is a discrete random process with the Markov propertyMarkov property

A stochastic process has the Markov property if the conditional probability distribution of future states of the process depend only upon the present state; that is, given the present, the future does not depend on the past.

Basilio Bona July 2010 28

Page 29: Probabilistic Fundamentals in Robotics - polito.it · Probabilistic Fundamentals in Robotics Basic Concepts in Probability Basilio Bona DAUIN – Politecnico di Torino July 2010.

Environment interaction

Measurements: are perceptual interaction between the robot and the environment obtained through specificrobot and the environment obtained through specific equipment (called also perceptions).

Control actions: are change in the state of the world obtained through active asserting forces.

Odometer data: are of perceptual data that convey the i f ti b t th b t h f t t hinformation about the robot change of status; as such they are not considered measurements, but control data, i th th ff t f t l tisince they measure the effect of control actions.

Basilio Bona July 2010 29

Page 30: Probabilistic Fundamentals in Robotics - polito.it · Probabilistic Fundamentals in Robotics Basic Concepts in Probability Basilio Bona DAUIN – Politecnico di Torino July 2010.

Probabilistic generative laws

Evolution of state is governed by probabilistic laws. 

If state is complete and Markov then evolution dependsIf state is complete and Markov, then evolution depends only on present state and control actions

St t t iti b bilit

Measurements are generated, according to probabilistic 

State transition probability

g , g plaws, from the present state only

Measurement probability

Basilio Bona July 2010 30

Measurement probability

Page 31: Probabilistic Fundamentals in Robotics - polito.it · Probabilistic Fundamentals in Robotics Basic Concepts in Probability Basilio Bona DAUIN – Politecnico di Torino July 2010.

Dynamical stochastic system

Temporal generative model Hidden Markov model (HMM) 

Dynamic Bayesian network (DBN)Dynamic Bayesian network (DBN) 

Basilio Bona July 2010 31

Page 32: Probabilistic Fundamentals in Robotics - polito.it · Probabilistic Fundamentals in Robotics Basic Concepts in Probability Basilio Bona DAUIN – Politecnico di Torino July 2010.

Belief distribution

h i b li f i i f h b ’ i l k l dWhat is a belief: it is a measure of the robot’s internal knowledge about the true state of the environment

Belief is traditionally expressed as conditional probability distributions.

Belief distribution: assigns a probability (or a density) to each possible hypothesis about the true state, based upon available data (measurements and controls)

State belief (prior)Prediction

Correction/update

Basilio Bona July 2010 32

State belief (posterior)

Correction/update

Page 33: Probabilistic Fundamentals in Robotics - polito.it · Probabilistic Fundamentals in Robotics Basic Concepts in Probability Basilio Bona DAUIN – Politecnico di Torino July 2010.

Bayes filter

Basic algorithm

Prediction

U d tUpdate

Basilio Bona July 2010 33

Page 34: Probabilistic Fundamentals in Robotics - polito.it · Probabilistic Fundamentals in Robotics Basic Concepts in Probability Basilio Bona DAUIN – Politecnico di Torino July 2010.

Mathematical formulation of the Bayesian filter (1)

the state is complete

Basilio Bona July 2010 34

Page 35: Probabilistic Fundamentals in Robotics - polito.it · Probabilistic Fundamentals in Robotics Basic Concepts in Probability Basilio Bona DAUIN – Politecnico di Torino July 2010.

Mathematical formulation of the Bayesian filter (2)

the state is complete

Basilio Bona July 2010 35

......

Page 36: Probabilistic Fundamentals in Robotics - polito.it · Probabilistic Fundamentals in Robotics Basic Concepts in Probability Basilio Bona DAUIN – Politecnico di Torino July 2010.

Mathematical formulation of the Bayesian filter (3)

The filter requires three probability distributions

Basilio Bona July 2010 36

Page 37: Probabilistic Fundamentals in Robotics - polito.it · Probabilistic Fundamentals in Robotics Basic Concepts in Probability Basilio Bona DAUIN – Politecnico di Torino July 2010.

Bayes filter recursion

Basilio Bona July 2010 37

Page 38: Probabilistic Fundamentals in Robotics - polito.it · Probabilistic Fundamentals in Robotics Basic Concepts in Probability Basilio Bona DAUIN – Politecnico di Torino July 2010.

Causal vs. diagnostic reasoning

A rover obtains a measurement z from a door th t b (O) l d (C)that can be open (O) or closed (C)

Easier to obtain

Basilio Bona July 2010 38

Page 39: Probabilistic Fundamentals in Robotics - polito.it · Probabilistic Fundamentals in Robotics Basic Concepts in Probability Basilio Bona DAUIN – Politecnico di Torino July 2010.

Example

Basilio Bona July 2010 39

Page 40: Probabilistic Fundamentals in Robotics - polito.it · Probabilistic Fundamentals in Robotics Basic Concepts in Probability Basilio Bona DAUIN – Politecnico di Torino July 2010.

References

Many textbooks on Probability Theory and Statistics– Bertsekas, D. P., and J. N. Tsitsiklis. Introduction to Probability. Athena , , y

Scientific Press, 2002.

– Grimmett, G. R., and D. R. Stirzaker. Probability and Random Processes. 3rd ed Oxford University Press 2001ed., Oxford University Press, 2001.

– Ross S., A First Course in Probability. 8th ed., Prentice Hall, 2009.

Other materialsOther materials– http://cs.ubc.ca/~arnaud/stat302.html: slides from the course by A. Doucet, 

University of British Columbia

– video course: http://academicearth.org/lectures/introduction‐probability‐and‐counting: UCLA/MATHEMATICS – Introduction: Probability and Counting, by Mark Sawyer | Math and Probability for Life Sciencesby Mark Sawyer | Math and Probability for Life Sciences

Basilio Bona July 2010 40

Page 41: Probabilistic Fundamentals in Robotics - polito.it · Probabilistic Fundamentals in Robotics Basic Concepts in Probability Basilio Bona DAUIN – Politecnico di Torino July 2010.

Thank you.

Any question?

Basilio Bona July 2010 41

Page 42: Probabilistic Fundamentals in Robotics - polito.it · Probabilistic Fundamentals in Robotics Basic Concepts in Probability Basilio Bona DAUIN – Politecnico di Torino July 2010.

PhD course 2010 Outline pptxPhD_course_2010‐Outline.pptx

Basilio Bona July 2010 42