Create VectorGeometry.cpp

Moved old geometry methods here, and implemented those new ones mentioned in Vector.h.