C++ implementation and Unit tests for Geometry and associated structs

With the Python implementation as reference, add C++ implementations of classes representing geometric shapes, and unit tests for these.