Add a control method of the servo motor