Add Doxygen
Add some code source for tests
Clean includes
Upgrade tests