Velocity Motion Model

etin Merili

25.09.2007

Outline
Preliminaries
Kinematic Configuration Probabilistic Kinematics

Velocity Motion Model

Derivation Exact Motion Real Motion Algorithms

Kinematic Configuration
In general the configuration of a robot can be
described by six parameters.

Three-dimensional cartesian coordinates plus three

Euler angles pitch, roll, and tilt. on a planar surface.

Throughout this section, we consider robots operating

The state space of such

systems is threedimensional (x,y,).

Dynamic Bayesian Network for Controls, States, and Sensations

Robot Motion
Robot motion is inherently uncertain. How can we model this uncertainty?

Reasons for Motion Errors

ideal case

different wheel diameters

bump and many more

carpet
6

Probabilistic Motion Models

To implement the Bayes Filter, we need

the transition model p(x | x, u).

The term p(x | x, u) specifies a posterior

probability, that action u carries the robot from x to x.

In this section we will specify, how

p(x | x, u) can be modeled based on the motion equations.

7

Typical Motion Models

In practice, one often finds two types of motion
models:
Odometry-based Velocity-based (dead reckoning)

Odometry-based models are used when systems

are equipped with wheel encoders. no wheel encoders are given.

Velocity-based models have to be applied when They calculate the new pose based on the
velocities and the time elapsed.
8

Dead Reckoning

Derived from deduced reckoning. Mathematical procedure for determining

the present location of a vehicle. Achieved by calculating the current pose of the vehicle based on its velocities and the time elapsed.

Velocity-Based Model

10

Mathematical Derivation

On Board

11

Equation for the Velocity Model

Center of circle:

with

12

Posterior Probability for Velocity Model

correction: |v| => v^2, |w| => w^2

13

The atan2 Function

Extends the inverse tangent and correctly
copes with the signs of x and y.

14

Calculating the Probability (zerocentered)

For a normal distribution
Algorithm prob_normal_distribution(a,b): return

For a triangular distribution

Algorithm prob_triangular_distribution(a,b): return
15

Typical Distributions for Probabilistic Motion Models

Normal distribution Triangular distribution

2 x =

e 2

1x 2 2

2 x =

0 ifx 6

62 x
6
2
16

Sampling from Velocity Model

17

How to Sample from Normal or Triangular Distributions?

Sampling from a normal distribution
Algorithm sample_normal_distribution(b): return

Sampling from a triangular distribution

Algorithm sample_triangular_distribution(b): return
18

Normally Distributed Samples

106 samples

19

For Triangular Distribution

103 samples

104 samples

105 samples

106 samples

20

Examples (velocity based)

21