interesting
/
riscv-openocd
1
0
Fork 0
Code Issues Pull Requests Projects Releases Wiki Activity

Merge pull request #1109 from aap-sc/aap-sc/sbus_fixup 

target/riscv: sys bus v1 fix for sizes greater than 4
This commit is contained in:
Anatoly Parshintsev 2024-09-03 11:07:31 +03:00 committed by GitHub
parent 8ea44aa381 ebb8c057a6
commit 22bbdd2a5e
No known key found for this signature in database
GPG Key ID: B5690EEEBB952194
1 changed files with 7 additions and 4 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

11
src/target/riscv/riscv-013.c
View File

@ -16,6 +16,7 @@
#include "target/target.h" #include "target/target.h"
#include "target/algorithm.h" #include "target/algorithm.h"
#include "target/target_type.h" #include "target/target_type.h"
#include <helper/align.h>
#include <helper/log.h> #include <helper/log.h>
#include "jtag/jtag.h" #include "jtag/jtag.h"
#include "target/register.h" #include "target/register.h"
@ -3253,6 +3254,9 @@ static int read_memory_bus_v1(struct target *target, target_addr_t address,
return ERROR_NOT_IMPLEMENTED; return ERROR_NOT_IMPLEMENTED;
} }
assert(size <= 16);
assert(IS_PWR_OF_2(size));
dm013_info_t *dm = get_dm(target); dm013_info_t *dm = get_dm(target);
if (!dm) if (!dm)
return ERROR_FAIL; return ERROR_FAIL;
@ -3288,7 +3292,6 @@ static int read_memory_bus_v1(struct target *target, target_addr_t address,
* be unnecessary. * be unnecessary.
*/ */
uint32_t sbvalue[4] = {0}; uint32_t sbvalue[4] = {0};
assert(size <= 16);
for (uint32_t i = (next_address - address) / size; i < count - 1; i++) { for (uint32_t i = (next_address - address) / size; i < count - 1; i++) {
const uint32_t size_in_words = DIV_ROUND_UP(size, 4); const uint32_t size_in_words = DIV_ROUND_UP(size, 4);
struct riscv_batch *batch = riscv_batch_alloc(target, size_in_words); struct riscv_batch *batch = riscv_batch_alloc(target, size_in_words);
@ -3309,10 +3312,10 @@ static int read_memory_bus_v1(struct target *target, target_addr_t address,
const size_t last_key = batch->read_keys_used - 1; const size_t last_key = batch->read_keys_used - 1;
for (size_t k = 0; k <= last_key; ++k) { for (size_t k = 0; k <= last_key; ++k) {
sbvalue[k] = riscv_batch_get_dmi_read_data(batch, sbvalue[k] = riscv_batch_get_dmi_read_data(batch, last_key - k);
last_key - k); buf_set_u32(buffer + i * size + k * 4, 0, MIN(32, 8 * size), sbvalue[k]);
buf_set_u32(buffer + i * size + k * 4, 0, 8 * size, sbvalue[k]);
} }
riscv_batch_free(batch); riscv_batch_free(batch);
const target_addr_t read_addr = address + i * increment; const target_addr_t read_addr = address + i * increment;
log_memory_access(read_addr, sbvalue, size, true); log_memory_access(read_addr, sbvalue, size, true);