Fixed bug in transforming Vector3D & Vector2D and added som tests & comments
Added some more comments