// File: jenniferdr[P]proyectoIAI/a_estrella.cc
// Function: a_estrella(char*, int, int (*)(char*))
Nodo* a_estrella(int8 inicial[16], int peso, int (*h)(int8 inicial[16])) {

  using namespace std;

  priority_queue<Nodo*, vector<Nodo*>, CompNodo> cola;
  unordered_map<long long int, Nodo*> abiertos;
  unordered_set<long long int> cerrados;

  int nodos_expandidos = 0;

  // Inicializar nodo del estado inicial
  Nodo* nodo_i = new Nodo();
  memcpy(nodo_i->estado, inicial, 16*sizeof(int8));
  nodo_i->distancia = 0;
  nodo_i->heuristica = peso * (*h)(nodo_i->estado);
  for (int i = 0; i < 16; i++) {
    if (inicial[i] == 0) {
      nodo_i->posicion_cero = i;
      break;
    }
  }
  nodo_i->predecesor = NULL;

  cola.push(nodo_i);
  abiertos[compactar_full(inicial)] = nodo_i;

  int movs[4] = {-4,-1,1,4};

  while (!cola.empty()) {

    Nodo* nodo = cola.top();

    cola.pop();
    abiertos.erase( compactar_full(nodo->estado) );
    cerrados.insert( compactar_full(nodo->estado) );

    // Cuando se expande un sucesor que ya está en los abiertos con un costo
    // mayor, como el API no permite borrarlo de la cola, se marca como borrado.
    // Para marcarlo se coloca su predecesor como NULL y su distancia de la raíz
    // es mayor a cero (así lo podemos distinguir de la raíz)
    // Aquí lo detectamos y liberamos la memoria asociada.
    if (nodo->predecesor == NULL && nodo->distancia != 0) {
      delete nodo;
      continue;
    }

    nodos_expandidos++;

    if ( is_goal(nodo) ) {
      std::cout << "Nodos expandidos: " << nodos_expandidos << std::endl;
      std::cout << "Pasos para la solución: " << (int) nodo->distancia << std::endl;
      return nodo;
    }

    // Expansión de sucesores
    // El arreglo movs[] guarda los offsets desde la casilla actual del blanco
    // hacia donde podría moverse. Para cada uno determinamos si es un movimiento
    // válido y expandimos el nodo de manera correspondiente.
    for (int i = 0; i < 4; i++) {

      if (puedeMoverse(movs[i], nodo->posicion_cero)) {
	int8 temp[16];
	memcpy(&temp, &(nodo->estado), 16*sizeof(int8));

	char ficha = temp[nodo->posicion_cero + movs[i]];
	temp[nodo->posicion_cero] = ficha;
	temp[nodo->posicion_cero + movs[i]] = 0;

	long long int indice = compactar_full(temp);

	// Si es un nodo que ya estaba cerrado, saltarlo
	if ( cerrados.count(indice) > 0 ) continue;

	unsigned char g_tentativo = nodo->distancia + 1;

	Nodo* hijo;

	if ( abiertos.count(indice) > 0) {
	  hijo = abiertos[indice];
	  if ( g_tentativo <= hijo->distancia ) {
	    // Lo marcamos como 'borrado' y cuando los consigamos,
	    // lo ignoramos.
	    hijo->predecesor = NULL;

	    Nodo* nhijo = new Nodo();
	    memcpy(nhijo->estado, &temp, 16*sizeof(int8));
	    nhijo->posicion_cero = nodo->posicion_cero + movs[i];
	    nhijo->distancia = g_tentativo;
	    nhijo->heuristica = g_tentativo + peso * (*h)(temp);
	    nhijo->predecesor = nodo;
	    abiertos[indice] = nhijo;
	    cola.push(nhijo);
	  }

	} else {
	  hijo = new Nodo();
	  memcpy(hijo->estado, &temp, 16*sizeof(int8));
	  hijo->posicion_cero = nodo->posicion_cero + movs[i];
	  hijo->distancia = g_tentativo;
	  hijo->heuristica = g_tentativo + peso * (*h)(temp);
	  hijo->predecesor = nodo;

	  abiertos[indice] = hijo;
	  cola.push(hijo);
	}
      }

    }
  }

  return NULL;
}

// Assembly:
pushq %rbp
movq %rsp, %rbp
subq $0x240, %rsp            # imm = 0x240
movq %rdi, -0x10(%rbp)
movl %esi, -0x14(%rbp)
movq %rdx, -0x20(%rbp)
leaq -0x40(%rbp), %rdi
callq 0x2f50
leaq -0x78(%rbp), %rdi
callq 0x2f80
leaq -0xb0(%rbp), %rdi
callq 0x2fa0
movl $0x0, -0xb4(%rbp)
movl $0x28, %edi
callq 0x21b0
movq %rax, -0x160(%rbp)
jmp 0x26a1
movq -0x160(%rbp), %rax
xorps %xmm0, %xmm0
movaps %xmm0, 0x10(%rax)
movaps %xmm0, (%rax)
movq $0x0, 0x20(%rax)
movq %rax, -0xc0(%rbp)
movq -0xc0(%rbp), %rax
movq -0x10(%rbp), %rcx
movups (%rcx), %xmm0
movups %xmm0, (%rax)
movq -0xc0(%rbp), %rax
movb $0x0, 0x10(%rax)
movl -0x14(%rbp), %eax
movl %eax, -0x168(%rbp)
movq -0x20(%rbp), %rax
movq -0xc0(%rbp), %rdi
callq *%rax
movl %eax, -0x164(%rbp)
jmp 0x26fb
movl -0x164(%rbp), %ecx
movl -0x168(%rbp), %eax
imull %ecx, %eax
movb %al, %cl
movq -0xc0(%rbp), %rax
movb %cl, 0x11(%rax)
movl $0x0, -0xd0(%rbp)
cmpl $0x10, -0xd0(%rbp)
jge 0x2799
movq -0x10(%rbp), %rax
movslq -0xd0(%rbp), %rcx
movsbl (%rax,%rcx), %eax
cmpl $0x0, %eax
jne 0x2786
movl -0xd0(%rbp), %eax
movb %al, %cl
movq -0xc0(%rbp), %rax
movb %cl, 0x20(%rax)
jmp 0x2799
movq %rax, %rcx
movl %edx, %eax
movq %rcx, -0xc8(%rbp)
movl %eax, -0xcc(%rbp)
leaq -0xb0(%rbp), %rdi
callq 0x31d0
leaq -0x78(%rbp), %rdi
callq 0x31f0
leaq -0x40(%rbp), %rdi
callq 0x3210
jmp 0x2e52
jmp 0x2788
movl -0xd0(%rbp), %eax
addl $0x1, %eax
movl %eax, -0xd0(%rbp)
jmp 0x2720
movq -0xc0(%rbp), %rax
movq $0x0, 0x18(%rax)
leaq -0x40(%rbp), %rdi
leaq -0xc0(%rbp), %rsi
callq 0x2fc0
jmp 0x27ba
movq -0xc0(%rbp), %rax
movq %rax, -0x178(%rbp)
movq -0x10(%rbp), %rdi
callq 0x25f0
movq %rax, -0xd8(%rbp)
leaq -0x78(%rbp), %rdi
leaq -0xd8(%rbp), %rsi
callq 0x3010
movq %rax, -0x170(%rbp)
jmp 0x27f1
movq -0x170(%rbp), %rax
movq -0x178(%rbp), %rcx
movq %rcx, (%rax)
movq 0x9807(%rip), %rax      # 0xc010
movq %rax, -0xf0(%rbp)
movq 0x9801(%rip), %rax      # 0xc018
movq %rax, -0xe8(%rbp)
leaq -0x40(%rbp), %rdi
callq 0x3040
movb %al, -0x179(%rbp)
jmp 0x282f
movb -0x179(%rbp), %al
xorb $-0x1, %al
testb $0x1, %al
jne 0x2840
jmp 0x2e15
leaq -0x40(%rbp), %rdi
callq 0x3060
movq %rax, -0x188(%rbp)
jmp 0x2852
movq -0x188(%rbp), %rax
movq (%rax), %rax
movq %rax, -0xf8(%rbp)
leaq -0x40(%rbp), %rdi
callq 0x3080
jmp 0x286e
movq -0xf8(%rbp), %rdi
callq 0x25f0
movq %rax, -0x100(%rbp)
leaq -0x78(%rbp), %rdi
leaq -0x100(%rbp), %rsi
callq 0x30d0
jmp 0x2893
movq -0xf8(%rbp), %rdi
callq 0x25f0
movq %rax, -0x108(%rbp)
leaq -0xb0(%rbp), %rdi
leaq -0x108(%rbp), %rsi
callq 0x3100
movb %dl, -0x191(%rbp)
movq %rax, -0x190(%rbp)
jmp 0x28c8
movb -0x191(%rbp), %al
movq -0x190(%rbp), %rcx
movq %rcx, -0x118(%rbp)
movb %al, -0x110(%rbp)
movq -0xf8(%rbp), %rax
cmpq $0x0, 0x18(%rax)
jne 0x292a
movq -0xf8(%rbp), %rax
movsbl 0x10(%rax), %eax
cmpl $0x0, %eax
je 0x292a
movq -0xf8(%rbp), %rax
movq %rax, -0x1a0(%rbp)
cmpq $0x0, %rax
je 0x2925
movq -0x1a0(%rbp), %rdi
movl $0x28, %esi
callq 0x21c0
jmp 0x281e
movl -0xb4(%rbp), %eax
incl %eax
movl %eax, -0xb4(%rbp)
movq -0xf8(%rbp), %rdi
callq 0x7de0
movb %al, -0x1a1(%rbp)
jmp 0x294c
movb -0x1a1(%rbp), %al
testb $0x1, %al
jne 0x295b
jmp 0x2a12
movq 0x10676(%rip), %rdi     # 0x12fd8
leaq 0x96b7(%rip), %rsi      # 0xc020
callq 0x21a0
movq %rax, -0x1b0(%rbp)
jmp 0x2977
movq -0x1b0(%rbp), %rdi
movl -0xb4(%rbp), %esi
callq 0x2310
movq %rax, -0x1b8(%rbp)
jmp 0x2992
movq -0x1b8(%rbp), %rdi
movq 0x10628(%rip), %rsi     # 0x12fc8
callq 0x21d0
jmp 0x29a7
movq 0x1062a(%rip), %rdi     # 0x12fd8
leaq 0x967e(%rip), %rsi      # 0xc033
callq 0x21a0
movq %rax, -0x1c0(%rbp)
jmp 0x29c3
movq -0x1c0(%rbp), %rdi
movq -0xf8(%rbp), %rax
movsbl 0x10(%rax), %esi
callq 0x2310
movq %rax, -0x1c8(%rbp)
jmp 0x29e3
movq -0x1c8(%rbp), %rdi
movq 0x105d7(%rip), %rsi     # 0x12fc8
callq 0x21d0
jmp 0x29f8
movq -0xf8(%rbp), %rax
movq %rax, -0x8(%rbp)
movl $0x1, -0x11c(%rbp)
jmp 0x2e27
movl $0x0, -0x120(%rbp)
cmpl $0x4, -0x120(%rbp)
jge 0x2e10
movslq -0x120(%rbp), %rax
movl -0xf0(%rbp,%rax,4), %edi
movq -0xf8(%rbp), %rax
movsbl 0x20(%rax), %esi
callq 0x85c0
movb %al, -0x1c9(%rbp)
jmp 0x2a4f
movb -0x1c9(%rbp), %al
testb $0x1, %al
jne 0x2a5e
jmp 0x2dfa
movq -0xf8(%rbp), %rax
movups (%rax), %xmm0
movaps %xmm0, -0x130(%rbp)
movq -0xf8(%rbp), %rax
movsbl 0x20(%rax), %eax
movslq -0x120(%rbp), %rcx
movl -0xf0(%rbp,%rcx,4), %ecx
addl %ecx, %eax
cltq
movb -0x130(%rbp,%rax), %al
movb %al, -0x131(%rbp)
movb -0x131(%rbp), %cl
movq -0xf8(%rbp), %rax
movsbq 0x20(%rax), %rax
movb %cl, -0x130(%rbp,%rax)
movq -0xf8(%rbp), %rax
movsbl 0x20(%rax), %eax
movslq -0x120(%rbp), %rcx
movl -0xf0(%rbp,%rcx,4), %ecx
addl %ecx, %eax
cltq
movb $0x0, -0x130(%rbp,%rax)
leaq -0x130(%rbp), %rdi
callq 0x25f0
movq %rax, -0x140(%rbp)
leaq -0xb0(%rbp), %rdi
leaq -0x140(%rbp), %rsi
callq 0x3140
movq %rax, -0x1d8(%rbp)
jmp 0x2b06
movq -0x1d8(%rbp), %rax
cmpq $0x0, %rax
jbe 0x2b18
jmp 0x2dfc
movq -0xf8(%rbp), %rax
movb 0x10(%rax), %al
incb %al
movb %al, -0x141(%rbp)
leaq -0x78(%rbp), %rdi
leaq -0x140(%rbp), %rsi
callq 0x3170
movq %rax, -0x1e0(%rbp)
jmp 0x2b43
movq -0x1e0(%rbp), %rax
cmpq $0x0, %rax
jbe 0x2cd2
leaq -0x78(%rbp), %rdi
leaq -0x140(%rbp), %rsi
callq 0x31a0
movq %rax, -0x1e8(%rbp)
jmp 0x2b6d
movq -0x1e8(%rbp), %rax
movq (%rax), %rax
movq %rax, -0x150(%rbp)
movzbl -0x141(%rbp), %eax
movq -0x150(%rbp), %rcx
movsbl 0x10(%rcx), %ecx
cmpl %ecx, %eax
jg 0x2ccd
movq -0x150(%rbp), %rax
movq $0x0, 0x18(%rax)
movl $0x28, %edi
callq 0x21b0
movq %rax, -0x1f0(%rbp)
jmp 0x2bba
movq -0x1f0(%rbp), %rax
xorps %xmm0, %xmm0
movaps %xmm0, 0x10(%rax)
movaps %xmm0, (%rax)
movq $0x0, 0x20(%rax)
movq %rax, -0x158(%rbp)
movq -0x158(%rbp), %rax
movaps -0x130(%rbp), %xmm0
movups %xmm0, (%rax)
movq -0xf8(%rbp), %rax
movl 0x20(%rax), %eax
movslq -0x120(%rbp), %rcx
movl -0xf0(%rbp,%rcx,4), %ecx
addl %ecx, %eax
movb %al, %cl
movq -0x158(%rbp), %rax
movb %cl, 0x20(%rax)
movb -0x141(%rbp), %cl
movq -0x158(%rbp), %rax
movb %cl, 0x10(%rax)
movzbl -0x141(%rbp), %eax
movl %eax, -0x1fc(%rbp)
movl -0x14(%rbp), %eax
movl %eax, -0x1f8(%rbp)
movq -0x20(%rbp), %rax
leaq -0x130(%rbp), %rdi
callq *%rax
movl %eax, -0x1f4(%rbp)
jmp 0x2c4c
movl -0x1fc(%rbp), %eax
movl -0x1f4(%rbp), %edx
movl -0x1f8(%rbp), %ecx
imull %edx, %ecx
addl %ecx, %eax
movb %al, %cl
movq -0x158(%rbp), %rax
movb %cl, 0x11(%rax)
movq -0xf8(%rbp), %rcx
movq -0x158(%rbp), %rax
movq %rcx, 0x18(%rax)
movq -0x158(%rbp), %rax
movq %rax, -0x210(%rbp)
leaq -0x78(%rbp), %rdi
leaq -0x140(%rbp), %rsi
callq 0x31a0
movq %rax, -0x208(%rbp)
jmp 0x2ca8
movq -0x208(%rbp), %rax
movq -0x210(%rbp), %rcx
movq %rcx, (%rax)
leaq -0x40(%rbp), %rdi
leaq -0x158(%rbp), %rsi
callq 0x2fc0
jmp 0x2ccb
jmp 0x2ccd
jmp 0x2df8
movl $0x28, %edi
callq 0x21b0
movq %rax, -0x218(%rbp)
jmp 0x2ce5
movq -0x218(%rbp), %rax
xorps %xmm0, %xmm0
movaps %xmm0, 0x10(%rax)
movaps %xmm0, (%rax)
movq $0x0, 0x20(%rax)
movq %rax, -0x150(%rbp)
movq -0x150(%rbp), %rax
movaps -0x130(%rbp), %xmm0
movups %xmm0, (%rax)
movq -0xf8(%rbp), %rax
movl 0x20(%rax), %eax
movslq -0x120(%rbp), %rcx
movl -0xf0(%rbp,%rcx,4), %ecx
addl %ecx, %eax
movb %al, %cl
movq -0x150(%rbp), %rax
movb %cl, 0x20(%rax)
movb -0x141(%rbp), %cl
movq -0x150(%rbp), %rax
movb %cl, 0x10(%rax)
movzbl -0x141(%rbp), %eax
movl %eax, -0x224(%rbp)
movl -0x14(%rbp), %eax
movl %eax, -0x220(%rbp)
movq -0x20(%rbp), %rax
leaq -0x130(%rbp), %rdi
callq *%rax
movl %eax, -0x21c(%rbp)
jmp 0x2d77
movl -0x224(%rbp), %eax
movl -0x21c(%rbp), %edx
movl -0x220(%rbp), %ecx
imull %edx, %ecx
addl %ecx, %eax
movb %al, %cl
movq -0x150(%rbp), %rax
movb %cl, 0x11(%rax)
movq -0xf8(%rbp), %rcx
movq -0x150(%rbp), %rax
movq %rcx, 0x18(%rax)
movq -0x150(%rbp), %rax
movq %rax, -0x238(%rbp)
leaq -0x78(%rbp), %rdi
leaq -0x140(%rbp), %rsi
callq 0x31a0
movq %rax, -0x230(%rbp)
jmp 0x2dd3
movq -0x230(%rbp), %rax
movq -0x238(%rbp), %rcx
movq %rcx, (%rax)
leaq -0x40(%rbp), %rdi
leaq -0x150(%rbp), %rsi
callq 0x2fc0
jmp 0x2df6
jmp 0x2df8
jmp 0x2dfa
jmp 0x2dfc
movl -0x120(%rbp), %eax
addl $0x1, %eax
movl %eax, -0x120(%rbp)
jmp 0x2a1c
jmp 0x281e
movq $0x0, -0x8(%rbp)
movl $0x1, -0x11c(%rbp)
leaq -0xb0(%rbp), %rdi
callq 0x31d0
leaq -0x78(%rbp), %rdi
callq 0x31f0
leaq -0x40(%rbp), %rdi
callq 0x3210
movq -0x8(%rbp), %rax
addq $0x240, %rsp            # imm = 0x240
popq %rbp
retq
movq -0xc8(%rbp), %rdi
callq 0x2320
nop