re-add dynamics (pose) noise, and make noise configurable
tune params to do better on 4_circle
plot pose error, and add legends
collect data at every timestep, not only when drawing
simplify dynamics func to use derivatives from current timestep

(this means state is now [x, y, theta] instead of [x, y, theta, xdot,
ydot, thetadot].)