my last working stuff
Merge branch 'master' of https://github.com/mefox/robotautonomy_hw2
bfs is osum
bfs is osum
bfs is osum