Camino Optimo Finalizado

camino.py

@@ -81,38 +81,45 @@ def encontrarCamino(matriz,posicionInicial, posicionFinal):
 
         def factible(direc,pos):
 
-            def movimientoAceptado(direccion : Direccion, bloque : int):
-                #print(direccion.name, bloque)
-                if(direccion == Direccion.Arriba):
-
-                    #arriba = [2,4,5,8,9,10,11]
-                    arriba = [2,3,6,7,8,10,11]
-                    if(bloque in arriba):
-                        return True
-                    return False
-                if(direccion == Direccion.Abajo):
-                    #abajo = [2,3,6,7,8,10,11]
-                    abajo = [2,4,5,8,9,10,11]
-                    if(bloque in abajo):
-                        return True
-                    return False
-                    #if(bloquePosterio.value == 2 or bloquePosterio.value == 3
-                    #   or bloquePosterio.value == 6 or bloquePosterio.value == 7
-                    #   or bloquePosterio.value == 10 or bloquePosterio.value == 11):
-                    #    return True
-                    #return False
-                if(direccion == Direccion.Izquierda):
-                    #izquierda = [1,3,4,7,8,9,11]
-                    izquierda = [1,5,6,7,9,10,11]
-                    if(bloque in izquierda):
-                        return True
-                    return False
-                if(direccion == Direccion.Derecha):
-                    #derecha = [1,6,7,9,10,11]
-                    derecha = [1,3,4,7,8,9,11]
-                    if(bloque in derecha):
-                        return True
-                    return False
+            def movimientoAceptado(direccion : Direccion, bloque : int, bloqueSiguiente : int):
+
+                def moviAcept(direccion : Direccion, bloque : int):
+                    #print(direccion.name, bloque)
+                    if(direccion == Direccion.Arriba):
+
+                        #arriba = [2,4,5,8,9,10,11]
+                        arriba = [2,3,6,7,8,10,11]
+                        if(bloque in arriba):
+                            return True
+                        return False
+                    if(direccion == Direccion.Abajo):
+                        #abajo = [2,3,6,7,8,10,11]
+                        abajo = [2,4,5,8,9,10,11]
+                        if(bloque in abajo):
+                            return True
+                        return False
+                        #if(bloquePosterio.value == 2 or bloquePosterio.value == 3
+                        #   or bloquePosterio.value == 6 or bloquePosterio.value == 7
+                        #   or bloquePosterio.value == 10 or bloquePosterio.value == 11):
+                        #    return True
+                        #return False
+                    if(direccion == Direccion.Izquierda):
+                        #izquierda = [1,3,4,7,8,9,11]
+                        izquierda = [1,5,6,7,9,10,11]
+                        if(bloque in izquierda):
+                            return True
+                        return False
+                    if(direccion == Direccion.Derecha):
+                        #derecha = [1,6,7,9,10,11]
+                        derecha = [1,3,4,7,8,9,11]
+                        if(bloque in derecha):
+                            return True
+                        return False
+                    
+                direcSiguiente = Direccion((direccion.value + 2) % 4)
+                if(moviAcept(direccion,bloque) and moviAcept(direcSiguiente,bloqueSiguiente)):
+                    return True
+                return False
             #pos = sol[-1]
             
             if(pos == posicionInicial):                
@@ -131,7 +138,7 @@ def encontrarCamino(matriz,posicionInicial, posicionFinal):
                 #print(f"Descartado Edificio {direccion} : {pos}")
                 return False           
 
-            if(not movimientoAceptado(direc,matriz[sol[-1][0]][sol[-1][1]])):
+            if(not movimientoAceptado(direc,matriz[sol[-1][0]][sol[-1][1]],matriz[pos[0]][pos[1]])):
                 #print(f"Descartado Movimiento no aceptado {direccion} : {sol[-1]}")
                 return False
 
@@ -226,8 +233,9 @@ matriz = [["02","02","00","01","05"],
 #pos = mAdy[6][0]
 #mAdy[6][0] = 2
 
-sol = encontrarCamino(matriz,(5,2),(0,3))
+sol = encontrarCamino(matriz,(5,2),(6,0))
 
 #mAdy[6][0] = pos
 
-print(sol)
\ No newline at end of file
+for s in sol:
+    print(s) 
\ No newline at end of file