Some printing for debugging calibration and added commands