Add test for guess matrix in GICP

This commit adds a test unit to prove that #887 fixes #754.
If you replace this line with `reg.align (output);` the test unit will fail because GICP can't make a perfect alignment in only one iteration.
When providing a guess matrix, the alignement is perfect with only 1 iteration because the guess matrix is exactly the right one.