Servo calibration. Rewritten & untested -- pushing so it can be looked at.
Merge pull request #25 from ptressel/master

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