Add normalization to Vec3D
Initial transformations