Added doxygen missing documentation

Fixed indentation and white spaces
Removed old TODO

Removed unused functions