Algoritmo listo

:)
arreglado error al buscar el vecino más cercano