Added some memory cleanup to BFS
Addressed TODO in BFS - invalid nodes, missing graph or no path out are now all handled by returning NULL as is desirable