// File: /workspace/github_c_makefile_star2_O3/ataradov[P]edbg/target_st_stm32g0.c
// Function: target_select
static void target_select(target_options_t *options)
{
  uint32_t idcode, flash_size;
  bool locked;

  dap_disconnect();
  dap_connect(DAP_INTERFACE_SWD);
  dap_reset_pin(0);
  dap_reset_link();

  // Stop the core
  dap_write_word(DHCSR, DHCSR_DBGKEY | DHCSR_DEBUGEN | DHCSR_HALT);
  dap_write_word(DEMCR, DEMCR_VC_CORERESET);
  dap_write_word(AIRCR, AIRCR_VECTKEY | AIRCR_SYSRESETREQ);

  dap_reset_pin(1);
  sleep_ms(10);

  idcode = dap_read_word(DBG_IDCODE);

  for (int i = 0; i < ARRAY_SIZE(devices); i++)
  {
    if (devices[i].idcode != (idcode & DEVICE_ID_MASK))
      continue;

    verbose("Target: %s\n", devices[i].name);

    target_device = devices[i];
    target_options = *options;

    flash_size = (dap_read_word(FLASH_SIZE_REG) & FLASH_SIZE_REG_MASK) * FLASH_SIZE_REG_MULT;

    target_check_options(&target_options, flash_size, FLASH_PAGE_SIZE);

    locked = (0xaa != (dap_read_word(OPTIONS_OPTR) & FLASH_OPTR_RDP_MASK));

    if (locked && !options->unlock)
      error_exit("target is locked, unlock is necessary");

    dap_write_word(FLASH_KEYR, FLASH_KEYR_KEY1);
    dap_write_word(FLASH_KEYR, FLASH_KEYR_KEY2);
    dap_write_word(FLASH_OPTKEYR, FLASH_OPTKEYR_KEY1);
    dap_write_word(FLASH_OPTKEYR, FLASH_OPTKEYR_KEY2);
    dap_write_word(FLASH_CR, 0);

    check(0 == dap_read_word(FLASH_CR), "Failed to unlock the flash for write operation. Try to power cycle the target.");

    return;
  }

  error_exit("unknown target device (DBG_IDCODE = 0x%08x)", idcode);
}

// Assembly:
pushq %r14
pushq %rbx
pushq %rax
movq %rdi, %rbx
callq 0x65ab
movl $0x1, %edi
callq 0x654e
xorl %edi, %edi
callq 0x709f
callq 0x6789
movl $0xe000edf0, %edi       # imm = 0xE000EDF0
movl $0xa05f0003, %esi       # imm = 0xA05F0003
callq 0x7269
movl $0xe000edfc, %edi       # imm = 0xE000EDFC
movl $0x1, %esi
callq 0x7269
movl $0xe000ed0c, %edi       # imm = 0xE000ED0C
movl $0x5fa0004, %esi        # imm = 0x5FA0004
callq 0x7269
movl $0x1, %edi
callq 0x709f
movl $0xa, %edi
callq 0x7d8c
movl $0x40015800, %edi       # imm = 0x40015800
callq 0x721a
movzwl %ax, %ecx
cmpl $0x6460, %ecx           # imm = 0x6460
je 0xbb89
cmpl $0x6466, %ecx           # imm = 0x6466
jne 0xbc98
leaq 0xf171(%rip), %r14      # 0x1acf8
jmp 0xbb90
leaq 0xf150(%rip), %r14      # 0x1ace0
movq 0x10(%r14), %rsi
leaq 0x6cca(%rip), %rdi      # 0x12865
xorl %eax, %eax
callq 0x7a90
movq 0x10(%r14), %rax
movq %rax, 0x730f3(%rip)     # 0x7eca0
movups (%r14), %xmm0
movups %xmm0, 0x730d8(%rip)    # 0x7ec90
movups (%rbx), %xmm0
movups 0x10(%rbx), %xmm1
movups 0x20(%rbx), %xmm2
movups %xmm0, 0x730de(%rip)    # 0x7eca8
movups %xmm1, 0x730e7(%rip)    # 0x7ecb8
movups %xmm2, 0x730f0(%rip)    # 0x7ecc8
movq 0x30(%rbx), %rax
movq %rax, 0x730f5(%rip)     # 0x7ecd8
leaq 0x730be(%rip), %r14     # 0x7eca8
movl $0x1fff75e0, %edi       # imm = 0x1FFF75E0
callq 0x721a
movzbl %al, %esi
shll $0xa, %esi
movq %r14, %rdi
movl $0x800, %edx            # imm = 0x800
callq 0x8ec8
movl $0x1fff7800, %edi       # imm = 0x1FFF7800
callq 0x721a
cmpb $-0x56, %al
je 0xbc29
cmpb $0x0, 0x8(%rbx)
jne 0xbc29
leaq 0x6409(%rip), %rdi      # 0x1202b
xorl %eax, %eax
callq 0x7ca5
movl $0x40022008, %edi       # imm = 0x40022008
movl $0x45670123, %esi       # imm = 0x45670123
callq 0x7269
movl $0x40022008, %edi       # imm = 0x40022008
movl $0xcdef89ab, %esi       # imm = 0xCDEF89AB
callq 0x7269
movl $0x4002200c, %edi       # imm = 0x4002200C
movl $0x8192a3b, %esi        # imm = 0x8192A3B
callq 0x7269
movl $0x4002200c, %edi       # imm = 0x4002200C
movl $0x4c5d6e7f, %esi       # imm = 0x4C5D6E7F
callq 0x7269
movl $0x40022014, %edi       # imm = 0x40022014
xorl %esi, %esi
callq 0x7269
movl $0x40022014, %edi       # imm = 0x40022014
callq 0x721a
xorl %edi, %edi
testl %eax, %eax
sete %dil
leaq 0x771d(%rip), %rsi      # 0x133a7
xorl %eax, %eax
addq $0x8, %rsp
popq %rbx
popq %r14
jmp 0x7bcc
leaq 0x7757(%rip), %rdi      # 0x133f6
movl %eax, %esi
xorl %eax, %eax
addq $0x8, %rsp
popq %rbx
popq %r14
jmp 0x7ca5