Consider the distance traveled by. differential wheeled robot given the rotations of its wheels.
We have the expected (commanded) Displacement + unexpected slips, which we can split into radial and tangenet displacement.
As grows, the uncertainty of the position grows as well. Error will propagate faster orthogonally to the robots direction of motion.
How about using a sensor to correct this? those are noisy too! But lets do it anyway.
The variance of each componenet in a random variable has a weight proportional to how much it contributes to the final value. Time for a partial derivative!
let be a function that maps (a sensor reading) to a random variable . is the standard deviation of
and the variance:
if is multi-variable:
where and are and matrices holding the variances of the input and output and is a Jacobian Matrix.
This chapter explains some math for Line Fitting and Odometry and its pretty interesting, but I’m skipping it because if I really need to reference this later, I’m better off looking at the textbook.