SAMCRA básico casi terminado

Falta devolver el camino encontrado por el algoritmo.
Versión completa de SAMCRA sin probar aún