int fileio_write_u32(struct fileio *fileio_p, uint32_t data) { uint8_t buf[4]; h_u32_to_be(buf, data); size_t size_written; int retval = fileio_write(fileio_p, 4, buf, &size_written); if (ERROR_OK == retval && size_written != sizeof(uint32_t)) retval = -EIO; return retval; }
int fileio_write_u32(fileio_t *fileio, u32 data) { u8 buf[4]; u32 size_written; int retval; h_u32_to_be(buf, data); if ((retval = fileio_local_write(fileio, 4, buf, &size_written)) != ERROR_OK) return retval; 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; }
/* read JTAG buffer into big-endian u32 */ int arm_jtag_buf_to_be32(u8 *in_buf, void *priv, struct scan_field_s *field) { h_u32_to_be(((u8*)priv), le_to_h_u32(in_buf)); return ERROR_OK; }