Added calibration mode

This mode allows the PID controller to run on the inputs only, but not
use the PID math for the outputs.