Inserindo fila e busca em largura. Incompleto ainda, mas ta aí.