one servo works
first version working'