Adding test code + Doxygen support