Add Matrix4f tests, Vector4f fix