Added touch calibration

Added touch calibration function. Not saved to flash memory yet.