Added extra invert func for vec3 class

Improved translation test for mat4
Other minor improvements