Much boilerplate; fleshed out mat3 and mat4
Finally added UnitTest++; rewriting tests