- DD(sl, "xpsr = 0x%08x\n", read_uint32(sl->q_buf, 64));
- DD(sl, "main_sp = 0x%08x\n", read_uint32(sl->q_buf, 68));
- DD(sl, "process_sp = 0x%08x\n", read_uint32(sl->q_buf, 72));
- DD(sl, "rw = 0x%08x\n", read_uint32(sl->q_buf, 76));
- DD(sl, "rw2 = 0x%08x\n", read_uint32(sl->q_buf, 80));
-}
-
-#else /* stlinkv2 */
-
-static void _stlink_usb_read_all_regs(stlink_t *sl, reg *regp) {
- struct stlink_libusb * const slu = sl->backend_data;
- unsigned char* const buf = sl->q_buf;
- unsigned char* const cmd_buf = sl->c_buf;
- ssize_t size;
- int i;
-
-#define STLINK_JTAG_COMMAND 0xf2
-#define STLINK_JTAG_READALLREGS2 0x3a
- memset(cmd_buf, 0, STLINK_CMD_SIZE);
- cmd_buf[0] = STLINK_JTAG_COMMAND;
- cmd_buf[1] = STLINK_JTAG_READALLREGS2;
- size = send_recv(slu, cmd_buf, STLINK_CMD_SIZE, buf, 84);
-
- if (size == -1) {
- printf("[!] send_recv\n");
- return;
- }
-
- sl->q_len = (size_t) size;
-
- for(i=0; i<16; i++)
- regp->r[i]= read_uint32(sl->q_buf, i*4);
-
- regp->xpsr = read_uint32(sl->q_buf, 64);
- regp->main_sp = read_uint32(sl->q_buf, 68);
- regp->process_sp = read_uint32(sl->q_buf, 72);
- regp->rw = read_uint32(sl->q_buf, 76);
- regp->rw2 = read_uint32(sl->q_buf, 80);
+ DLOG("xpsr = 0x%08x\n", read_uint32(sl->q_buf, 64));
+ DLOG("main_sp = 0x%08x\n", read_uint32(sl->q_buf, 68));
+ DLOG("process_sp = 0x%08x\n", read_uint32(sl->q_buf, 72));
+ DLOG("rw = 0x%08x\n", read_uint32(sl->q_buf, 76));
+ DLOG("rw2 = 0x%08x\n", read_uint32(sl->q_buf, 80));