Mat setupMatrix(double hSmallToGlass[], double hGlassToSmall[]) {
Mat hSmallToGlassMat = HMatFromArray(hSmallToGlass);
Mat hGlassToSmallMat = hSmallToGlassMat.inv();
double denominator = hGlassToSmallMat.get(2, 2)[0];
for (int i = 0; i < 3; i++)
for (int j = 0; j < 3; j++)
hGlassToSmall[i * 3 + j] = hGlassToSmallMat.get(i, j)[0] / denominator;
return hSmallToGlassMat;
}
