Improvements reto. There are still issues.
Fix finding from review with Ervin
Code format, non functional changes only.
Remove unused files
Improve make file. Dependencies to header files still missing
Add comment. There is a memory leak in the code!