1 of 4

Dead reckoning math

Paul Grayson 2013-12-12

2 of 4

Where am I?

α

Δr cos α

Δr sin α

Δr

3 of 4

Rotation and translation

α

Δx = Δr cos α

Δy = Δr sin α

Δr

Δα

For each encoder tick:

Calibrate Δr and Δα

4 of 4

More efficient approximation

Δx = r cos α = rc Δy = r sin α = rs

Δc = cos(α+Δα) − cos(α)

= cos(α) cos(Δα) − sin(α) sin(Δα) - cos(α)

≈ −Δα sin(α) = −Δα⋅s

Δs = sin(α+Δα) - sin(α)

= sin(α) cos(Δα) + cos(α) sin(Δα) - sin(α)

≈Δα cos(α) = +Δα⋅c

No trig necessary!