Implemented a basic and untested pathing BFS algorithm