Changed names and added switchServo() method