Got BFS Working. Code is messy and needs to be cleaned... but its functional