When a state is switched while moving, speed is just set to zero. Speed should actually be commanded to zero and slowly changed.
When a state is switched while moving, speed is just set to zero. Speed should actually be commanded to zero and slowly changed.