completing servo implementation