Put 2D geometry stuff into a namespace
Add Mat (Matrix) class, some test code in main