Servo calibration. Rewritten & untested -- pushing so it can be looked at. (Previous commit had this message on the wrong file.)