Servo calibration. Rewritten & untested -- pushing so it can be looked at.

(Previous commit had this message on the wrong file.)