Added function to set motor speed for the new firmware