Servo test program

The program tests servo range of motion.