+uint32_t _stlink_usb_read_debug32(stlink_t *sl, uint32_t addr) {
+ struct stlink_libusb * const slu = sl->backend_data;
+ unsigned char* const rdata = sl->q_buf;
+ unsigned char* const cmd = sl->c_buf;
+ ssize_t size;
+ const int rep_len = 8;
+
+ int i = fill_command(sl, SG_DXFER_FROM_DEV, rep_len);
+ cmd[i++] = STLINK_DEBUG_COMMAND;
+ cmd[i++] = STLINK_JTAG_READDEBUG_32BIT;
+ write_uint32(&cmd[i], addr);
+ size = send_recv(slu, 1, cmd, slu->cmd_len, rdata, rep_len);
+ if (size == -1) {
+ printf("[!] send_recv\n");
+ return;
+ }
+ return read_uint32(rdata, 4);
+}
+
+void _stlink_usb_write_debug32(stlink_t *sl, uint32_t addr, uint32_t data) {
+ struct stlink_libusb * const slu = sl->backend_data;
+ unsigned char* const rdata = sl->q_buf;
+ unsigned char* const cmd = sl->c_buf;
+ ssize_t size;
+ const int rep_len = 2;
+
+ int i = fill_command(sl, SG_DXFER_FROM_DEV, rep_len);
+ cmd[i++] = STLINK_DEBUG_COMMAND;
+ cmd[i++] = STLINK_JTAG_WRITEDEBUG_32BIT;
+ write_uint32(&cmd[i], addr);
+ write_uint32(&cmd[i + 4], data);
+ size = send_recv(slu, 1, cmd, slu->cmd_len, rdata, rep_len);
+ if (size == -1) {
+ printf("[!] send_recv\n");
+ return;
+ }
+}
+