Added some unit test implementations
This branch is now a stub. All implementation is in a new branch called Geometry.