DoubleArrayToMatrix4d + unit test