// File: /workspace/github_cpp_makefile_star2_O3/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
pushq %r15
pushq %r14
pushq %r13
pushq %r12
pushq %rbx
subq $0xe8, %rsp
movq %rdx, 0x20(%rsp)
movl %esi, 0xc(%rsp)
movq %rdi, %r14
xorps %xmm0, %xmm0
movaps %xmm0, 0x40(%rsp)
movq $0x0, 0x50(%rsp)
leaq 0xa8(%rsp), %rax
movq %rax, -0x30(%rax)
movl $0x1, %ecx
movq %rcx, -0x28(%rax)
movups %xmm0, -0x20(%rax)
movl $0x3f800000, %edx       # imm = 0x3F800000
movl %edx, -0x10(%rax)
movups %xmm0, -0x8(%rax)
leaq 0xe0(%rsp), %rax
movq %rax, -0x30(%rax)
movq %rcx, -0x28(%rax)
movups %xmm0, -0x20(%rax)
movl %edx, -0x10(%rax)
movups %xmm0, -0x8(%rax)
movl $0x28, %edi
callq 0x2180
movq %rax, 0x30(%rsp)
xorps %xmm0, %xmm0
movaps %xmm0, 0x10(%rax)
movq $0x0, 0x20(%rax)
movups (%r14), %xmm0
movups %xmm0, (%rax)
movq %rax, %rdi
callq *0x20(%rsp)
imull 0xc(%rsp), %eax
movq 0x30(%rsp), %rcx
movb %al, 0x11(%rcx)
xorl %eax, %eax
cmpb $0x0, (%r14,%rax)
je 0x25e5
incq %rax
cmpq $0x10, %rax
jne 0x25d3
jmp 0x25e8
movb %al, 0x20(%rcx)
movq $0x0, 0x18(%rcx)
leaq 0x40(%rsp), %rdi
leaq 0x30(%rsp), %rsi
callq 0x2ac0
movq 0x30(%rsp), %rbx
xorl %ecx, %ecx
xorl %eax, %eax
movsbq (%r14,%rcx), %rdx
orq %rdx, %rax
shlq $0x4, %rax
incq %rcx
cmpq $0x10, %rcx
jne 0x2608
sarq $0x4, %rax
leaq 0x10(%rsp), %rsi
movq %rax, (%rsi)
leaq 0x78(%rsp), %rdi
callq 0x2da8
movq %rbx, (%rax)
movq 0x40(%rsp), %rax
cmpq 0x48(%rsp), %rax
je 0x294d
leaq 0x70(%rsp), %r12
leaq 0x39ce(%rip), %rbp      # 0x6020
xorl %ebx, %ebx
movq (%rax), %r14
leaq 0x40(%rsp), %rdi
callq 0x2b40
xorl %ecx, %ecx
xorl %eax, %eax
movsbq (%r14,%rcx), %rdx
orq %rdx, %rax
shlq $0x4, %rax
incq %rcx
cmpq $0x10, %rcx
jne 0x2665
sarq $0x4, %rax
movq %rax, 0x10(%rsp)
leaq 0x78(%rsp), %rdi
leaq 0x10(%rsp), %rsi
callq 0x3126
xorl %ecx, %ecx
xorl %eax, %eax
movsbq (%r14,%rcx), %rdx
orq %rdx, %rax
shlq $0x4, %rax
incq %rcx
cmpq $0x10, %rcx
jne 0x2696
sarq $0x4, %rax
movq %rax, 0x70(%rsp)
leaq 0xb0(%rsp), %rdi
movq %rdi, 0x10(%rsp)
movq %r12, %rsi
leaq 0x10(%rsp), %rdx
callq 0x3216
cmpq $0x0, 0x18(%r14)
je 0x2925
movq %r14, %rdi
callq 0x374a
incl %ebx
testb %al, %al
jne 0x2955
movl %ebx, 0x3c(%rsp)
xorl %r15d, %r15d
movl (%rbp,%r15,4), %ebx
movsbl 0x20(%r14), %esi
movl %ebx, %edi
callq 0x37c1
testb %al, %al
je 0x2912
movslq %ebx, %rbx
movups (%r14), %xmm0
movaps %xmm0, 0x10(%rsp)
movsbq 0x20(%r14), %rax
leaq (%rbx,%rax), %rcx
movb 0x10(%rsp,%rcx), %cl
movb %cl, 0x10(%rsp,%rax)
movsbq 0x20(%r14), %rax
addq %rbx, %rax
movb $0x0, 0x10(%rsp,%rax)
xorl %eax, %eax
xorl %ecx, %ecx
movsbq 0x10(%rsp,%rax), %rdx
orq %rdx, %rcx
shlq $0x4, %rcx
incq %rax
cmpq $0x10, %rax
jne 0x2739
sarq $0x4, %rcx
movq %rcx, 0x70(%rsp)
movq 0xb0(%rsp), %rdi
movq 0xb8(%rsp), %r8
movq %rcx, %rax
xorl %edx, %edx
divq %r8
movq (%rdi,%rdx,8), %rax
testq %rax, %rax
je 0x27ac
movq %rdx, %rsi
movq (%rax), %r9
cmpq 0x8(%r9), %rcx
je 0x2912
movq (%r9), %r9
testq %r9, %r9
je 0x27ac
movq 0x8(%r9), %rdi
movq %rdi, %rax
xorl %edx, %edx
divq %r8
cmpq %rsi, %rdx
jne 0x27ac
cmpq %rdi, %rcx
jne 0x2789
jmp 0x2912
movb 0x10(%r14), %r13b
incb %r13b
movq 0x78(%rsp), %rdi
movq 0x80(%rsp), %r8
movq %rcx, %rax
xorl %edx, %edx
divq %r8
movq (%rdi,%rdx,8), %rax
testq %rax, %rax
je 0x28a4
movq %rdx, %rsi
movq (%rax), %r9
cmpq 0x8(%r9), %rcx
je 0x2807
movq (%r9), %r9
testq %r9, %r9
je 0x28a4
movq 0x8(%r9), %rdi
movq %rdi, %rax
xorl %edx, %edx
divq %r8
cmpq %rsi, %rdx
jne 0x28a4
cmpq %rdi, %rcx
jne 0x27e1
leaq 0x78(%rsp), %rdi
movq %r12, %rsi
callq 0x34a4
movq (%rax), %rax
movq %rax, 0x28(%rsp)
movzbl %r13b, %ecx
movsbl 0x10(%rax), %edx
cmpl %edx, %ecx
jg 0x2912
movq $0x0, 0x18(%rax)
movl $0x28, %edi
callq 0x2180
movq %rax, 0x68(%rsp)
xorps %xmm0, %xmm0
movaps %xmm0, 0x10(%rax)
movq $0x0, 0x20(%rax)
movaps 0x10(%rsp), %xmm0
movups %xmm0, (%rax)
addb 0x20(%r14), %bl
movb %bl, 0x20(%rax)
movb %r13b, 0x10(%rax)
leaq 0x10(%rsp), %rdi
callq *0x20(%rsp)
imull 0xc(%rsp), %eax
addb %al, %r13b
movq 0x68(%rsp), %rbx
movb %r13b, 0x11(%rbx)
movq %r14, 0x18(%rbx)
leaq 0x78(%rsp), %rdi
movq %r12, %rsi
callq 0x34a4
movq %rbx, (%rax)
leaq 0x40(%rsp), %rdi
leaq 0x68(%rsp), %rsi
callq 0x2ac0
jmp 0x2912
movl $0x28, %edi
callq 0x2180
movq %rax, 0x28(%rsp)
xorps %xmm0, %xmm0
movaps %xmm0, 0x10(%rax)
movq $0x0, 0x20(%rax)
movaps 0x10(%rsp), %xmm0
movups %xmm0, (%rax)
addb 0x20(%r14), %bl
movb %bl, 0x20(%rax)
movb %r13b, 0x10(%rax)
leaq 0x10(%rsp), %rdi
callq *0x20(%rsp)
imull 0xc(%rsp), %eax
addb %al, %r13b
movq 0x28(%rsp), %rbx
movb %r13b, 0x11(%rbx)
movq %r14, 0x18(%rbx)
leaq 0x78(%rsp), %rdi
movq %r12, %rsi
callq 0x34a4
movq %rbx, (%rax)
leaq 0x40(%rsp), %rdi
leaq 0x28(%rsp), %rsi
callq 0x2ac0
incq %r15
cmpq $0x4, %r15
jne 0x26f2
movl 0x3c(%rsp), %ebx
jmp 0x293d
cmpb $0x0, 0x10(%r14)
je 0x26d9
movl $0x28, %esi
movq %r14, %rdi
callq 0x2190
movq 0x40(%rsp), %rax
cmpq 0x48(%rsp), %rax
jne 0x2654
xorl %r14d, %r14d
jmp 0x29f8
movq 0x667c(%rip), %rdi      # 0x8fd8
leaq 0x36cd(%rip), %rsi      # 0x6030
movl $0x12, %edx
callq 0x21a0
movq 0x6664(%rip), %rdi      # 0x8fd8
movl %ebx, %esi
callq 0x22a0
movq %rax, %rbx
movq (%rax), %rax
movq -0x18(%rax), %rdi
addq %rbx, %rdi
movl $0xa, %esi
callq 0x2170
movsbl %al, %esi
movq %rbx, %rdi
callq 0x2030
movq %rax, %rdi
callq 0x2110
movq 0x662c(%rip), %rdi      # 0x8fd8
leaq 0x3690(%rip), %rsi      # 0x6043
movl $0x19, %edx
callq 0x21a0
movsbl 0x10(%r14), %esi
movq 0x660f(%rip), %rdi      # 0x8fd8
callq 0x22a0
movq %rax, %rbx
movq (%rax), %rax
movq -0x18(%rax), %rdi
addq %rbx, %rdi
movl $0xa, %esi
callq 0x2170
movsbl %al, %esi
movq %rbx, %rdi
callq 0x2030
movq %rax, %rdi
callq 0x2110
leaq 0xb0(%rsp), %rdi
callq 0x2b82
leaq 0x78(%rsp), %rdi
callq 0x2bfc
movq 0x40(%rsp), %rdi
testq %rdi, %rdi
je 0x2a26
movq 0x50(%rsp), %rsi
subq %rdi, %rsi
callq 0x2190
movq %r14, %rax
addq $0xe8, %rsp
popq %rbx
popq %r12
popq %r13
popq %r14
popq %r15
popq %rbp
retq
jmp 0x2a4b
jmp 0x2a4b
jmp 0x2a4b
jmp 0x2a4b
jmp 0x2a4b
jmp 0x2a4b
jmp 0x2a4b
jmp 0x2a4b
movq %rax, %rbx
leaq 0xb0(%rsp), %rdi
callq 0x2b82
leaq 0x78(%rsp), %rdi
callq 0x2bfc
movq 0x40(%rsp), %rdi
testq %rdi, %rdi
je 0x2a7c
movq 0x50(%rsp), %rsi
subq %rdi, %rsi
callq 0x2190
movq %rbx, %rdi
callq 0x22b0