Initial Mat4 implementation