Add servo test program.