Adding some unit tests for Matrix4d.
Aded a few more tests for Matrix4d.
More test cases for Matrix4d.
Again more tests for Matrix4d.