Partially optimized Vector3D class and made some other slight changes