Intentando la solución, finalizado la jugabilidad

Al estar por mas de 3 dias intentando comprender la logica de como resolver el problema que tengo, con la solucion del algoritmo, sinceramente no logro crear una funcion que me mostrara la solucion, si creo un algoritmo que en parte me busca un camino, pero me presento con varios problemas, ademas de que el limite de tiempo es cada vez menor. Aunque no me doy por vencido decido mejor terminar de forma completa y mejorando el proyecto en la parte que ya tengo completa.