Fix for continuous move

Added a linear acceleration and deceleration for continuous motion. Also
fixed how it calculated the desired speed