Refactoring servo positioning function; set_pos => set_angle.