Add Matrix4 tests

Maybe later I'll put something in to disable building of the tests, they
take a while to build.