Added Geometry2D class

Provides pretty much all the functions required for moreoless any