doxygen comments, some differnt code for pathfind
working path finding