Add some unittests

[dj2]

There are a few pieces like the Mat4 and Vec3 code which could do with some unit tests. Create them and put into the relevant examples.