Done with matrix integration from calibration. Taken in as a double[][] from Main