open-dobot movement MoveWithSpeed() algorithm