Add function to calibrate, clean up interface to have nice command line options.