Matlab - El camino mas corto con hormigas

Hola necesito desarrollar un algoritmo que encuentre el camino mas corto entre 2 posiciones en un grafo con pesos.
Tengo idea de como funciona el algoritmo pero no se como iniciar con las primeras hormigas aleatoreamente sin que se queden en un camino errado.
Agradezco a alguien que me ayude con este algoritmo, o si podría brindarme asesoría, es urgente.
Mil gracias