Daniel - fixed main.c, calibration of X and Y were switched around