Calibration program

Created calibration program, which uses the calibrate() function of Drive. Various other minor changes.