fix abrupt direction change bug when speed limited

Signed-off-by: James Pearman <jbpearman@mac.com>