Servo calibration + bugfixes
Merge remote-tracking branch 'GitHub/master'