Kalman-and-Bayesian-Filters-in-Python
Kalman-and-Bayesian-Filters-in-Python copied to clipboard
rlabbe
Ch11 - EKF: Error in Design the System Model (Robot Localization)
I believe there's an error in the section Design the System Model for the robot localization example. The motion model is actually providing a relationship between the past and future states (x, y, theta), not the derivatives of the states (x', y', theta'). Unless I'm missing something, these equations can be used as they are, and there's no need to compute the Jacobian.
The movement of a robot responding to rotational velocity cannot be described by linear state transitions. A Gaussian distribution passed through a rotational function is no longer Gaussian. Hence, we need to linearize, or use techniques such as the UKF or particle filter.
My formulation comes from Thrun's book Probabilistic Robots.
Yes, I agree on that. I think the confusion comes from the notation used. Isn't x "bar" the notation for the next state of x, and x "dot" (or x') the notation for the derivative of x? If so, how can we get the partial derivatives of x', y' and theta' if they are not defined:
