Agregadas Cosas al Algoritmo propio

Se agrego el Treemap, se agrego la clase Nodo y se cumplir varias
condiciones, toca arreglar la posición y dirección, y otras cosas que
ni idea.