static int jtagspi_cmd(struct flash_bank *bank, uint8_t cmd, uint32_t *addr, uint8_t *data, int len) { struct jtagspi_flash_bank *info = bank->driver_priv; struct scan_field fields[3]; uint8_t cmd_buf[4]; uint8_t *data_buf; int is_read, lenb, n; /* LOG_DEBUG("cmd=0x%02x len=%i", cmd, len); */ n = 0; fields[n].num_bits = 8; cmd_buf[0] = cmd; if (addr) { h_u24_to_be(cmd_buf + 1, *addr); fields[n].num_bits += 24; } flip_u8(cmd_buf, cmd_buf, 4); fields[n].out_value = cmd_buf; fields[n].in_value = NULL; n++; is_read = (len < 0); if (is_read) len = -len; lenb = DIV_ROUND_UP(len, 8); data_buf = malloc(lenb); if (lenb > 0) { if (data_buf == NULL) { LOG_ERROR("no memory for spi buffer"); return ERROR_FAIL; } if (is_read) { fields[n].num_bits = info->dr_len; fields[n].out_value = NULL; fields[n].in_value = NULL; n++; fields[n].out_value = NULL; fields[n].in_value = data_buf; } else { flip_u8(data, data_buf, lenb); fields[n].out_value = data_buf; fields[n].in_value = NULL; } fields[n].num_bits = len; n++; } jtagspi_set_ir(bank); jtag_add_dr_scan(info->tap, n, fields, TAP_IDLE); jtag_execute_queue(); if (is_read) flip_u8(data_buf, data, lenb); free(data_buf); return ERROR_OK; }
static int jtagspi_cmd(struct flash_bank *bank, uint8_t cmd, uint32_t *addr, uint8_t *data, int len) { struct jtagspi_flash_bank *info = bank->driver_priv; struct scan_field fields[6]; uint8_t marker = 1; uint8_t xfer_bits_buf[4]; uint8_t addr_buf[3]; uint8_t *data_buf; uint32_t xfer_bits; int is_read, lenb, n; /* LOG_DEBUG("cmd=0x%02x len=%i", cmd, len); */ is_read = (len < 0); if (is_read) len = -len; n = 0; fields[n].num_bits = 1; fields[n].out_value = ▮ fields[n].in_value = NULL; n++; xfer_bits = 8 + len - 1; /* cmd + read/write - 1 due to the counter implementation */ if (addr) xfer_bits += 24; h_u32_to_be(xfer_bits_buf, xfer_bits); flip_u8(xfer_bits_buf, xfer_bits_buf, 4); fields[n].num_bits = 32; fields[n].out_value = xfer_bits_buf; fields[n].in_value = NULL; n++; cmd = flip_u32(cmd, 8); fields[n].num_bits = 8; fields[n].out_value = &cmd; fields[n].in_value = NULL; n++; if (addr) { h_u24_to_be(addr_buf, *addr); flip_u8(addr_buf, addr_buf, 3); fields[n].num_bits = 24; fields[n].out_value = addr_buf; fields[n].in_value = NULL; n++; } lenb = DIV_ROUND_UP(len, 8); data_buf = malloc(lenb); if (lenb > 0) { if (data_buf == NULL) { LOG_ERROR("no memory for spi buffer"); return ERROR_FAIL; } if (is_read) { fields[n].num_bits = jtag_tap_count_enabled(); fields[n].out_value = NULL; fields[n].in_value = NULL; n++; fields[n].out_value = NULL; fields[n].in_value = data_buf; } else { flip_u8(data, data_buf, lenb); fields[n].out_value = data_buf; fields[n].in_value = NULL; } fields[n].num_bits = len; n++; } jtagspi_set_ir(bank); /* passing from an IR scan to SHIFT-DR clears BYPASS registers */ jtag_add_dr_scan(info->tap, n, fields, TAP_IDLE); jtag_execute_queue(); if (is_read) flip_u8(data_buf, data, lenb); free(data_buf); return ERROR_OK; }