Add function setSpeeds for 2 motors control