Fix motor speed not working as intended