Factoring out error reporting functionality.
+added initial test for geometric_objects example code
Further refactoring/cleaning
* Moving some functionality to the new ASaPUtil.h/cpp
* Removing #include and replacing with forward declarations wherever possible