Start of Matrix4 class, and a little bit of testing!