Controlling the servos with a program