Started on breadth first search

Got it done, messy implementation though