Modification of SetSpeed functions to handle -1 speed value as a normal stop

Modification of SetSpeed functions to handle -1 speed value as a normal stop, not as an emergency.