+#ifdef DEBUG_WAIT
+static const char *dap_reg_name(int instr, int reg_addr)
+{
+ char *reg_name = "UNK";
+
+ if (instr == JTAG_DP_DPACC) {
+ switch (reg_addr) {
+ case DP_ABORT:
+ reg_name = "ABORT";
+ break;
+ case DP_CTRL_STAT:
+ reg_name = "CTRL/STAT";
+ break;
+ case DP_SELECT:
+ reg_name = "SELECT";
+ break;
+ case DP_RDBUFF:
+ reg_name = "RDBUFF";
+ break;
+ case DP_WCR:
+ reg_name = "WCR";
+ break;
+ default:
+ reg_name = "UNK";
+ break;
+ }
+ }
+
+ if (instr == JTAG_DP_APACC) {
+ switch (reg_addr) {
+ case MEM_AP_REG_CSW:
+ reg_name = "CSW";
+ break;
+ case MEM_AP_REG_TAR:
+ reg_name = "TAR";
+ break;
+ case MEM_AP_REG_DRW:
+ reg_name = "DRW";
+ break;
+ case MEM_AP_REG_BD0:
+ reg_name = "BD0";
+ break;
+ case MEM_AP_REG_BD1:
+ reg_name = "BD1";
+ break;
+ case MEM_AP_REG_BD2:
+ reg_name = "BD2";
+ break;
+ case MEM_AP_REG_BD3:
+ reg_name = "BD3";
+ break;
+ case MEM_AP_REG_CFG:
+ reg_name = "CFG";
+ break;
+ case MEM_AP_REG_BASE:
+ reg_name = "BASE";
+ break;
+ case AP_REG_IDR:
+ reg_name = "IDR";
+ break;
+ default:
+ reg_name = "UNK";
+ break;
+ }
+ }
+
+ return reg_name;
+}
+#endif
+
+struct dap_cmd {
+ struct list_head lh;
+ uint8_t instr;
+ uint8_t reg_addr;
+ uint8_t RnW;
+ uint8_t *invalue;
+ uint8_t ack;
+ uint32_t memaccess_tck;
+ uint32_t dp_select;
+
+ struct scan_field fields[2];
+ uint8_t out_addr_buf;
+ uint8_t invalue_buf[4];
+ uint8_t outvalue_buf[4];
+};
+
+static void log_dap_cmd(const char *header, struct dap_cmd *el)
+{
+#ifdef DEBUG_WAIT
+ LOG_DEBUG("%s: %2s %6s %5s 0x%08x 0x%08x %2s", header,
+ el->instr == JTAG_DP_APACC ? "AP" : "DP",
+ dap_reg_name(el->instr, el->reg_addr),
+ el->RnW == DPAP_READ ? "READ" : "WRITE",
+ buf_get_u32(el->outvalue_buf, 0, 32),
+ buf_get_u32(el->invalue, 0, 32),
+ el->ack == JTAG_ACK_OK_FAULT ? "OK" :
+ (el->ack == JTAG_ACK_WAIT ? "WAIT" : "INVAL"));
+#endif
+}
+
+static struct dap_cmd *dap_cmd_new(uint8_t instr,
+ uint8_t reg_addr, uint8_t RnW,
+ uint8_t *outvalue, uint8_t *invalue,
+ uint32_t memaccess_tck)
+{
+ struct dap_cmd *cmd;
+
+ cmd = (struct dap_cmd *)calloc(1, sizeof(struct dap_cmd));
+ if (cmd != NULL) {
+ INIT_LIST_HEAD(&cmd->lh);
+ cmd->instr = instr;
+ cmd->reg_addr = reg_addr;
+ cmd->RnW = RnW;
+ if (outvalue != NULL)
+ memcpy(cmd->outvalue_buf, outvalue, 4);
+ cmd->invalue = (invalue != NULL) ? invalue : cmd->invalue_buf;
+ cmd->memaccess_tck = memaccess_tck;
+ }
+
+ return cmd;
+}
+
+static void flush_journal(struct list_head *lh)
+{
+ struct dap_cmd *el, *tmp;
+
+ list_for_each_entry_safe(el, tmp, lh, lh) {
+ list_del(&el->lh);
+ free(el);
+ }
+}
+