Implemented the new vector classes

Changed code where old Point2D or Point3D classes were used.