Separate animation frequency, control frequency
These parameters depend on maxSpeed & axleTrack

TODO: automatically update them
Adjust statistical motion model params
Move getVelocities to robot model
Fix bug when omega == 0