Move MulMatrix4 from vector3 to Matrix4 MulVec3. Add some Vector conversion functions. Set values in ray properly.