New organisation of the project

Changed and added header files with doxygen comment
new conroller, driving task, pathfinder task and timer