// File: /workspace/github_cpp_makefile_star2_O2/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, 0x28(%rsp)
movl %esi, 0x4(%rsp)
movq %rdi, %rbx
andq $0x0, 0x60(%rsp)
xorps %xmm0, %xmm0
movaps %xmm0, 0x50(%rsp)
leaq 0xe0(%rsp), %rax
movq %rax, -0x30(%rax)
pushq $0x1
popq %rcx
movq %rcx, -0x28(%rax)
movups %xmm0, -0x20(%rax)
movl $0x3f800000, %edx       # imm = 0x3F800000
movl %edx, -0x10(%rax)
movups %xmm0, -0x8(%rax)
leaq 0xa8(%rsp), %rax
movq %rax, -0x30(%rax)
movq %rcx, -0x28(%rax)
movups %xmm0, -0x20(%rax)
movl %edx, -0x10(%rax)
movups %xmm0, -0x8(%rax)
pushq $0x28
popq %rdi
callq 0x2180
andq $0x0, 0x20(%rax)
movq %rax, 0x38(%rsp)
xorps %xmm0, %xmm0
movaps %xmm0, 0x10(%rax)
movups (%rbx), %xmm0
movups %xmm0, (%rax)
movq %rax, %rdi
callq *0x28(%rsp)
imull 0x4(%rsp), %eax
movq 0x38(%rsp), %rcx
movb %al, 0x11(%rcx)
xorl %eax, %eax
cmpq $0x10, %rax
je 0x256e
cmpb $0x0, (%rbx,%rax)
je 0x256b
incq %rax
jmp 0x255a
movb %al, 0x20(%rcx)
andq $0x0, 0x18(%rcx)
leaq 0x50(%rsp), %rdi
leaq 0x38(%rsp), %rsi
callq 0x28f4
movq 0x38(%rsp), %r14
movq %rbx, %rdi
callq 0x249c
leaq 0x10(%rsp), %rsi
movq %rax, (%rsi)
leaq 0xb0(%rsp), %rdi
callq 0x2c6a
movq %r14, (%rax)
leaq 0x50(%rsp), %r12
leaq 0xb0(%rsp), %rbp
leaq 0x10(%rsp), %rbx
pushq $0x28
popq %r13
xorl %r15d, %r15d
movq 0x50(%rsp), %rax
cmpq 0x58(%rsp), %rax
je 0x27eb
movq (%rax), %r14
movq %r12, %rdi
callq 0x290a
movq %r14, %rdi
callq 0x249c
movq %rax, 0x10(%rsp)
movq %rbp, %rdi
movq %rbx, %rsi
callq 0x30fe
movq %r14, %rdi
callq 0x249c
movq %rax, 0x10(%rsp)
leaq 0x78(%rsp), %rdi
movq %rbx, %rsi
callq 0x3200
cmpq $0x0, 0x18(%r14)
jne 0x2628
cmpb $0x0, 0x10(%r14)
je 0x2628
movq %r14, %rdi
movq %r13, %rsi
callq 0x2190
jmp 0x25c0
movq %r14, %rdi
callq 0x3863
incl %r15d
testb %al, %al
jne 0x2824
movl %r15d, 0x44(%rsp)
xorl %r13d, %r13d
cmpq $0x10, %r13
je 0x27d8
leaq 0x39cc(%rip), %rax      # 0x6020
movl (%r13,%rax), %r12d
movsbl 0x20(%r14), %esi
movl %r12d, %edi
callq 0x39d6
testb %al, %al
je 0x26b5
movslq %r12d, %r15
movups (%r14), %xmm0
movaps %xmm0, 0x10(%rsp)
movsbq 0x20(%r14), %rax
leaq (%r15,%rax), %rcx
movb 0x10(%rsp,%rcx), %cl
movb %cl, 0x10(%rsp,%rax)
movsbq 0x20(%r14), %rax
addq %r15, %rax
movb $0x0, 0x10(%rsp,%rax)
movq %rbx, %rdi
callq 0x249c
movq %rax, 0x8(%rsp)
leaq 0x78(%rsp), %rdi
leaq 0x8(%rsp), %rsi
callq 0x3546
testq %rax, %rax
je 0x26bb
addq $0x4, %r13
jmp 0x2643
movb 0x10(%r14), %r12b
movq %rbp, %rdi
leaq 0x8(%rsp), %rsi
callq 0x3578
incb %r12b
testq %rax, %rax
je 0x276b
movq %rbp, %rdi
leaq 0x8(%rsp), %rsi
callq 0x35aa
movq (%rax), %rax
movq %rax, 0x30(%rsp)
movzbl %r12b, %ecx
movsbl 0x10(%rax), %edx
cmpl %edx, %ecx
jg 0x26b5
andq $0x0, 0x18(%rax)
pushq $0x28
popq %rdi
callq 0x2180
andq $0x0, 0x20(%rax)
movq %rax, 0x48(%rsp)
xorps %xmm0, %xmm0
movaps %xmm0, 0x10(%rax)
movaps 0x10(%rsp), %xmm0
movups %xmm0, (%rax)
addb 0x20(%r14), %r15b
movb %r15b, 0x20(%rax)
movb %r12b, 0x10(%rax)
movq %rbx, %rdi
callq *0x28(%rsp)
imull 0x4(%rsp), %eax
addb %al, %r12b
movq 0x48(%rsp), %r15
movb %r12b, 0x11(%r15)
movq %r14, 0x18(%r15)
movq %rbp, %rdi
leaq 0x8(%rsp), %rsi
callq 0x35aa
movq %r15, (%rax)
leaq 0x50(%rsp), %rdi
leaq 0x48(%rsp), %rsi
callq 0x28f4
jmp 0x26b5
pushq $0x28
popq %rdi
callq 0x2180
andq $0x0, 0x20(%rax)
movq %rax, 0x30(%rsp)
xorps %xmm0, %xmm0
movaps %xmm0, 0x10(%rax)
movaps 0x10(%rsp), %xmm0
movups %xmm0, (%rax)
addb 0x20(%r14), %r15b
movb %r15b, 0x20(%rax)
movb %r12b, 0x10(%rax)
movq %rbx, %rdi
callq *0x28(%rsp)
imull 0x4(%rsp), %eax
addb %al, %r12b
movq 0x30(%rsp), %r15
movb %r12b, 0x11(%r15)
movq %r14, 0x18(%r15)
movq %rbp, %rdi
leaq 0x8(%rsp), %rsi
callq 0x35aa
movq %r15, (%rax)
leaq 0x50(%rsp), %rdi
leaq 0x30(%rsp), %rsi
callq 0x28f4
jmp 0x26b5
movl 0x44(%rsp), %r15d
leaq 0x50(%rsp), %r12
pushq $0x28
popq %r13
jmp 0x25c0
xorl %r14d, %r14d
leaq 0x78(%rsp), %rdi
callq 0x2922
leaq 0xb0(%rsp), %rdi
callq 0x29d6
leaq 0x50(%rsp), %rdi
callq 0x2a7e
movq %r14, %rax
addq $0xe8, %rsp
popq %rbx
popq %r12
popq %r13
popq %r14
popq %r15
popq %rbp
retq
movq 0x67ad(%rip), %rdi      # 0x8fd8
leaq 0x37fe(%rip), %rsi      # 0x6030
callq 0x2170
movq %rax, %rdi
movl %r15d, %esi
callq 0x2270
movq %rax, %rdi
callq 0x2100
movq 0x6787(%rip), %rdi      # 0x8fd8
leaq 0x37eb(%rip), %rsi      # 0x6043
callq 0x2170
movsbl 0x10(%r14), %esi
movq %rax, %rdi
callq 0x2270
movq %rax, %rdi
callq 0x2100
jmp 0x27ee
jmp 0x288b
jmp 0x288b
jmp 0x288b
jmp 0x288b
jmp 0x288b
jmp 0x288b
jmp 0x288b
jmp 0x288b
jmp 0x288b
jmp 0x288b
movq %rax, %rbx
leaq 0x78(%rsp), %rdi
callq 0x2922
leaq 0xb0(%rsp), %rdi
callq 0x29d6
leaq 0x50(%rsp), %rdi
callq 0x2a7e
movq %rbx, %rdi
callq 0x2280