Added several other math utility classes

Mat4 is still missing...