Veamos estos algoritmos muy habituales, de Dijkstra y de las hormigas, empezamos por el de Dijkstra:
Ahora de las hormigas: