Add new controller with servo