finish breadth search
Merge pull request #2 from bryceholcomb/pathfinding_algo

finish breadth search