sys64738
/
blackmagic
1
0
Fork 0
Code Issues Pull Requests Projects Releases Wiki Activity

platform: code format and style

This commit is contained in:
Rafael Silva 2022-08-05 22:32:53 +01:00 committed by Rachel Mant
parent a1f0d28913
commit 564114df13
1 changed files with 168 additions and 72 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

226
src/platforms/hosted/platform.c
View File

@ -45,25 +45,29 @@ bmp_info_t info;
jtag_proc_t jtag_proc; jtag_proc_t jtag_proc;
static BMP_CL_OPTIONS_t cl_opts;
void gdb_ident(char *p, int count) void gdb_ident(char *p, int count)
{ {
snprintf(p, count, "%s (%s), %s", info.manufacturer, info.product, snprintf(p, count, "%s (%s), %s", info.manufacturer, info.product, info.version);
info.version);
} }
static void exit_function(void) static void exit_function(void)
{ {
libusb_exit_function(&info); libusb_exit_function(&info);
switch (info.bmp_type) { switch (info.bmp_type) {
case BMP_TYPE_CMSIS_DAP: case BMP_TYPE_CMSIS_DAP:
dap_exit_function(); dap_exit_function();
break; break;
default: default:
break; break;
} }
#ifdef ENABLE_RTT
#ifdef ENABLE_RTT
rtt_if_exit(); rtt_if_exit();
#endif #endif
fflush(stdout); fflush(stdout);
} }
@ -74,51 +78,59 @@ static void sigterm_handler(int sig)
exit(0); exit(0);
} }
static BMP_CL_OPTIONS_t cl_opts;
void platform_init(int argc, char **argv) void platform_init(int argc, char **argv)
{ {
cl_init(&cl_opts, argc, argv); cl_init(&cl_opts, argc, argv);
atexit(exit_function); atexit(exit_function);
signal(SIGTERM, sigterm_handler); signal(SIGTERM, sigterm_handler);
signal(SIGINT, sigterm_handler); signal(SIGINT, sigterm_handler);
if (cl_opts.opt_device) if (cl_opts.opt_device)
info.bmp_type = BMP_TYPE_BMP; info.bmp_type = BMP_TYPE_BMP;
else if (find_debuggers(&cl_opts, &info)) else if (find_debuggers(&cl_opts, &info))
exit(-1); exit(-1);
bmp_ident(&info); bmp_ident(&info);
switch (info.bmp_type) { switch (info.bmp_type) {
case BMP_TYPE_BMP: case BMP_TYPE_BMP:
if (serial_open(&cl_opts, info.serial)) if (serial_open(&cl_opts, info.serial))
exit(-1); exit(-1);
remote_init(); remote_init();
break; break;
case BMP_TYPE_STLINKV2: case BMP_TYPE_STLINKV2:
if (stlink_init(&info)) if (stlink_init(&info))
exit(-1); exit(-1);
break; break;
case BMP_TYPE_CMSIS_DAP: case BMP_TYPE_CMSIS_DAP:
if (dap_init(&info)) if (dap_init(&info))
exit(-1); exit(-1);
break; break;
case BMP_TYPE_LIBFTDI: case BMP_TYPE_LIBFTDI:
if (ftdi_bmp_init(&cl_opts, &info)) if (ftdi_bmp_init(&cl_opts, &info))
exit(-1); exit(-1);
break; break;
case BMP_TYPE_JLINK: case BMP_TYPE_JLINK:
if (jlink_init(&info)) if (jlink_init(&info))
exit(-1); exit(-1);
break; break;
default: default:
exit(-1); exit(-1);
} }
if (cl_opts.opt_mode != BMP_MODE_DEBUG) if (cl_opts.opt_mode != BMP_MODE_DEBUG)
exit(cl_execute(&cl_opts)); exit(cl_execute(&cl_opts));
else { else {
gdb_if_init(); gdb_if_init();
#ifdef ENABLE_RTT
#ifdef ENABLE_RTT
rtt_if_init(); rtt_if_init();
#endif #endif
return; return;
} }
} }
@ -127,14 +139,15 @@ int platform_adiv5_swdp_scan(uint32_t targetid)
{ {
info.is_jtag = false; info.is_jtag = false;
platform_max_frequency_set(cl_opts.opt_max_swj_frequency); platform_max_frequency_set(cl_opts.opt_max_swj_frequency);
switch (info.bmp_type) { switch (info.bmp_type) {
case BMP_TYPE_BMP: case BMP_TYPE_BMP:
case BMP_TYPE_LIBFTDI: case BMP_TYPE_LIBFTDI:
case BMP_TYPE_CMSIS_DAP: case BMP_TYPE_CMSIS_DAP:
return adiv5_swdp_scan(targetid); return adiv5_swdp_scan(targetid);
break; break;
case BMP_TYPE_STLINKV2:
{ case BMP_TYPE_STLINKV2: {
target_list_free(); target_list_free();
ADIv5_DP_t *dp = calloc(1, sizeof(*dp)); ADIv5_DP_t *dp = calloc(1, sizeof(*dp));
@ -152,8 +165,10 @@ int platform_adiv5_swdp_scan(uint32_t targetid)
} }
break; break;
} }
case BMP_TYPE_JLINK: case BMP_TYPE_JLINK:
return jlink_swdp_scan(&info); return jlink_swdp_scan(&info);
default: default:
return 0; return 0;
} }
@ -165,17 +180,20 @@ int swdptap_init(ADIv5_DP_t *dp)
switch (info.bmp_type) { switch (info.bmp_type) {
case BMP_TYPE_BMP: case BMP_TYPE_BMP:
return remote_swdptap_init(dp); return remote_swdptap_init(dp);
case BMP_TYPE_CMSIS_DAP: case BMP_TYPE_CMSIS_DAP:
return dap_swdptap_init(dp); return dap_swdptap_init(dp);
case BMP_TYPE_STLINKV2: case BMP_TYPE_STLINKV2:
case BMP_TYPE_JLINK: case BMP_TYPE_JLINK:
return 0; return 0;
case BMP_TYPE_LIBFTDI: case BMP_TYPE_LIBFTDI:
return libftdi_swdptap_init(dp); return libftdi_swdptap_init(dp);
default: default:
return -1; return -1;
} }
return -1;
} }
void platform_add_jtag_dev(uint32_t i, const jtag_dev_t *jtag_dev) void platform_add_jtag_dev(uint32_t i, const jtag_dev_t *jtag_dev)
@ -187,19 +205,22 @@ void platform_add_jtag_dev(uint32_t i, const jtag_dev_t *jtag_dev)
int platform_jtag_scan(const uint8_t *lrlens) int platform_jtag_scan(const uint8_t *lrlens)
{ {
info.is_jtag = true; info.is_jtag = true;
platform_max_frequency_set(cl_opts.opt_max_swj_frequency); platform_max_frequency_set(cl_opts.opt_max_swj_frequency);
switch (info.bmp_type) { switch (info.bmp_type) {
case BMP_TYPE_BMP: case BMP_TYPE_BMP:
case BMP_TYPE_LIBFTDI: case BMP_TYPE_LIBFTDI:
case BMP_TYPE_JLINK: case BMP_TYPE_JLINK:
case BMP_TYPE_CMSIS_DAP: case BMP_TYPE_CMSIS_DAP:
return jtag_scan(lrlens); return jtag_scan(lrlens);
case BMP_TYPE_STLINKV2: case BMP_TYPE_STLINKV2:
return jtag_scan_stlinkv2(&info, lrlens); return jtag_scan_stlinkv2(&info, lrlens);
default: default:
return -1; return -1;
} }
return -1;
} }
int platform_jtagtap_init(void) int platform_jtagtap_init(void)
@ -207,23 +228,28 @@ int platform_jtagtap_init(void)
switch (info.bmp_type) { switch (info.bmp_type) {
case BMP_TYPE_BMP: case BMP_TYPE_BMP:
return remote_jtagtap_init(&jtag_proc); return remote_jtagtap_init(&jtag_proc);
case BMP_TYPE_STLINKV2: case BMP_TYPE_STLINKV2:
return 0; return 0;
case BMP_TYPE_LIBFTDI: case BMP_TYPE_LIBFTDI:
return libftdi_jtagtap_init(&jtag_proc); return libftdi_jtagtap_init(&jtag_proc);
case BMP_TYPE_JLINK: case BMP_TYPE_JLINK:
return jlink_jtagtap_init(&info, &jtag_proc); return jlink_jtagtap_init(&info, &jtag_proc);
case BMP_TYPE_CMSIS_DAP: case BMP_TYPE_CMSIS_DAP:
return cmsis_dap_jtagtap_init(&jtag_proc); return cmsis_dap_jtagtap_init(&jtag_proc);
default: default:
return -1; return -1;
} }
return -1;
} }
void platform_adiv5_dp_defaults(ADIv5_DP_t *dp) void platform_adiv5_dp_defaults(ADIv5_DP_t *dp)
{ {
dp->dp_bmp_type = info.bmp_type; dp->dp_bmp_type = info.bmp_type;
switch (info.bmp_type) { switch (info.bmp_type) {
case BMP_TYPE_BMP: case BMP_TYPE_BMP:
if (cl_opts.opt_no_hl) { if (cl_opts.opt_no_hl) {
@ -231,10 +257,13 @@ void platform_adiv5_dp_defaults(ADIv5_DP_t *dp)
return; return;
} }
return remote_adiv5_dp_defaults(dp); return remote_adiv5_dp_defaults(dp);
case BMP_TYPE_STLINKV2: case BMP_TYPE_STLINKV2:
return stlink_adiv5_dp_defaults(dp); return stlink_adiv5_dp_defaults(dp);
case BMP_TYPE_CMSIS_DAP: case BMP_TYPE_CMSIS_DAP:
return dap_adiv5_dp_defaults(dp); return dap_adiv5_dp_defaults(dp);
default: default:
break; break;
} }
@ -247,14 +276,16 @@ int platform_jtag_dp_init(ADIv5_DP_t *dp)
case BMP_TYPE_LIBFTDI: case BMP_TYPE_LIBFTDI:
case BMP_TYPE_JLINK: case BMP_TYPE_JLINK:
return 0; return 0;
case BMP_TYPE_STLINKV2: case BMP_TYPE_STLINKV2:
return stlink_jtag_dp_init(dp); return stlink_jtag_dp_init(dp);
case BMP_TYPE_CMSIS_DAP: case BMP_TYPE_CMSIS_DAP:
return dap_jtag_dp_init(dp); return dap_jtag_dp_init(dp);
default: default:
return 0; return 0;
} }
return 0;
} }
char *platform_ident(void) char *platform_ident(void)
@ -262,18 +293,25 @@ char *platform_ident(void)
switch (info.bmp_type) { switch (info.bmp_type) {
case BMP_TYPE_NONE: case BMP_TYPE_NONE:
return "NONE"; return "NONE";
case BMP_TYPE_BMP: case BMP_TYPE_BMP:
return "BMP"; return "BMP";
case BMP_TYPE_STLINKV2: case BMP_TYPE_STLINKV2:
return "STLINKV2"; return "STLINKV2";
case BMP_TYPE_LIBFTDI: case BMP_TYPE_LIBFTDI:
return "LIBFTDI"; return "LIBFTDI";
case BMP_TYPE_CMSIS_DAP: case BMP_TYPE_CMSIS_DAP:
return "CMSIS_DAP"; return "CMSIS_DAP";
case BMP_TYPE_JLINK: case BMP_TYPE_JLINK:
return "JLINK"; return "JLINK";
}
default:
return NULL; return NULL;
}
} }
const char *platform_target_voltage(void) const char *platform_target_voltage(void)
@ -281,16 +319,19 @@ const char *platform_target_voltage(void)
switch (info.bmp_type) { switch (info.bmp_type) {
case BMP_TYPE_BMP: case BMP_TYPE_BMP:
return remote_target_voltage(); return remote_target_voltage();
case BMP_TYPE_STLINKV2: case BMP_TYPE_STLINKV2:
return stlink_target_voltage(&info); return stlink_target_voltage(&info);
case BMP_TYPE_LIBFTDI: case BMP_TYPE_LIBFTDI:
return libftdi_target_voltage(); return libftdi_target_voltage();
case BMP_TYPE_JLINK: case BMP_TYPE_JLINK:
return jlink_target_voltage(&info); return jlink_target_voltage(&info);
default: default:
break;
}
return NULL; return NULL;
}
} }
void platform_nrst_set_val(bool assert) void platform_nrst_set_val(bool assert)
@ -298,14 +339,19 @@ void platform_nrst_set_val(bool assert)
switch (info.bmp_type) { switch (info.bmp_type) {
case BMP_TYPE_STLINKV2: case BMP_TYPE_STLINKV2:
return stlink_nrst_set_val(&info, assert); return stlink_nrst_set_val(&info, assert);
case BMP_TYPE_BMP: case BMP_TYPE_BMP:
return remote_nrst_set_val(assert); return remote_nrst_set_val(assert);
case BMP_TYPE_JLINK: case BMP_TYPE_JLINK:
return jlink_nrst_set_val(&info, assert); return jlink_nrst_set_val(&info, assert);
case BMP_TYPE_LIBFTDI: case BMP_TYPE_LIBFTDI:
return libftdi_nrst_set_val(assert); return libftdi_nrst_set_val(assert);
case BMP_TYPE_CMSIS_DAP: case BMP_TYPE_CMSIS_DAP:
return dap_nrst_set_val(assert); return dap_nrst_set_val(assert);
default: default:
break; break;
} }
@ -316,50 +362,58 @@ bool platform_nrst_get_val(void)
switch (info.bmp_type) { switch (info.bmp_type) {
case BMP_TYPE_BMP: case BMP_TYPE_BMP:
return remote_nrst_get_val(); return remote_nrst_get_val();
case BMP_TYPE_STLINKV2: case BMP_TYPE_STLINKV2:
return stlink_nrst_get_val(); return stlink_nrst_get_val();
case BMP_TYPE_JLINK: case BMP_TYPE_JLINK:
return jlink_nrst_get_val(&info); return jlink_nrst_get_val(&info);
case BMP_TYPE_LIBFTDI: case BMP_TYPE_LIBFTDI:
return libftdi_nrst_get_val(); return libftdi_nrst_get_val();
default: default:
break;
}
return false; return false;
}
} }
void platform_max_frequency_set(uint32_t freq) void platform_max_frequency_set(uint32_t freq)
{ {
if (!freq) if (!freq)
return; return;
switch (info.bmp_type) { switch (info.bmp_type) {
case BMP_TYPE_BMP: case BMP_TYPE_BMP:
remote_max_frequency_set(freq); remote_max_frequency_set(freq);
break; break;
case BMP_TYPE_CMSIS_DAP: case BMP_TYPE_CMSIS_DAP:
dap_swj_clock(freq); dap_swj_clock(freq);
break; break;
case BMP_TYPE_LIBFTDI: case BMP_TYPE_LIBFTDI:
libftdi_max_frequency_set(freq); libftdi_max_frequency_set(freq);
break; break;
case BMP_TYPE_STLINKV2: case BMP_TYPE_STLINKV2:
stlink_max_frequency_set(&info, freq); stlink_max_frequency_set(&info, freq);
break; break;
case BMP_TYPE_JLINK: case BMP_TYPE_JLINK:
jlink_max_frequency_set(&info, freq); jlink_max_frequency_set(&info, freq);
break; break;
default: default:
DEBUG_WARN("Setting max SWJ frequency not yet implemented\n"); DEBUG_WARN("Setting max SWJ frequency not yet implemented\n");
break; break;
} }
uint32_t max_freq = platform_max_frequency_get(); uint32_t max_freq = platform_max_frequency_get();
if (max_freq == FREQ_FIXED) if (max_freq == FREQ_FIXED)
DEBUG_INFO("Device has fixed frequency for %s\n", DEBUG_INFO("Device has fixed frequency for %s\n", (info.is_jtag) ? "JTAG" : "SWD");
(info.is_jtag) ? "JTAG" : "SWD" );
else else
DEBUG_INFO("Speed set to %7.4f MHz for %s\n", DEBUG_INFO("Speed set to %7.4f MHz for %s\n", platform_max_frequency_get() / 1000000.0,
platform_max_frequency_get() / 1000000.0, (info.is_jtag) ? "JTAG" : "SWD");
(info.is_jtag) ? "JTAG" : "SWD" );
} }
uint32_t platform_max_frequency_get(void) uint32_t platform_max_frequency_get(void)
@ -367,20 +421,23 @@ uint32_t platform_max_frequency_get(void)
switch (info.bmp_type) { switch (info.bmp_type) {
case BMP_TYPE_BMP: case BMP_TYPE_BMP:
return remote_max_frequency_get(); return remote_max_frequency_get();
case BMP_TYPE_CMSIS_DAP: case BMP_TYPE_CMSIS_DAP:
return dap_swj_clock(0); return dap_swj_clock(0);
break;
case BMP_TYPE_LIBFTDI: case BMP_TYPE_LIBFTDI:
return libftdi_max_frequency_get(); return libftdi_max_frequency_get();
case BMP_TYPE_STLINKV2: case BMP_TYPE_STLINKV2:
return stlink_max_frequency_get(&info); return stlink_max_frequency_get(&info);
case BMP_TYPE_JLINK: case BMP_TYPE_JLINK:
return jlink_max_frequency_get(&info); return jlink_max_frequency_get(&info);
default: default:
DEBUG_WARN("Reading max SWJ frequency not yet implemented\n"); DEBUG_WARN("Reading max SWJ frequency not yet implemented\n");
break; return 0;
} }
return false;
} }
void platform_target_set_power(bool power) void platform_target_set_power(bool power)
@ -392,6 +449,7 @@ void platform_target_set_power(bool power)
else else
DEBUG_WARN("Powering up device unimplemented or failed\n"); DEBUG_WARN("Powering up device unimplemented or failed\n");
break; break;
default: default:
break; break;
} }
@ -401,32 +459,34 @@ bool platform_target_get_power(void)
{ {
switch (info.bmp_type) { switch (info.bmp_type) {
case BMP_TYPE_BMP: case BMP_TYPE_BMP:
return remote_target_get_power() ; return remote_target_get_power();
default: default:
return false ; return false;
} }
} }
uint32_t platform_target_voltage_sense(void) uint32_t platform_target_voltage_sense(void)
{ {
uint32_t targetVoltage = 0 ; uint32_t targetVoltage = 0;
switch (info.bmp_type) { switch (info.bmp_type) {
case BMP_TYPE_BMP: { case BMP_TYPE_BMP: {
const char * result ; const char *const result = remote_target_voltage();
uint32_t units = 0, tenths = 0 ;
result = remote_target_voltage() ;
if (result != NULL) { if (result != NULL) {
sscanf(result,"%"PRIu32".%"PRIu32, &units, &tenths) ; uint32_t units = 0;
targetVoltage = (units * 10) + tenths ; uint32_t tenths = 0;
sscanf(result, "%" PRIu32 ".%" PRIu32, &units, &tenths);
targetVoltage = (units * 10U) + tenths;
} }
break ; break;
} }
default: default:
break ; break;
} }
return targetVoltage ;
return targetVoltage;
} }
void platform_buffer_flush(void) void platform_buffer_flush(void)
@ -434,6 +494,7 @@ void platform_buffer_flush(void)
switch (info.bmp_type) { switch (info.bmp_type) {
case BMP_TYPE_LIBFTDI: case BMP_TYPE_LIBFTDI:
return libftdi_buffer_flush(); return libftdi_buffer_flush();
default: default:
break; break;
} }
@ -445,50 +506,80 @@ static void ap_decode_access(uint16_t addr, uint8_t RnW)
fprintf(stderr, "Read "); fprintf(stderr, "Read ");
else else
fprintf(stderr, "Write "); fprintf(stderr, "Write ");
if (addr < 0x100) { if (addr < 0x100) {
switch(addr) { switch (addr) {
case 0x00: case 0x00:
if (RnW) if (RnW)
fprintf(stderr, "DP_DPIDR :"); fprintf(stderr, "DP_DPIDR :");
else else
fprintf(stderr, "DP_ABORT :"); fprintf(stderr, "DP_ABORT :");
break; break;
case 0x04: fprintf(stderr, "CTRL/STAT:");
case 0x04:
fprintf(stderr, "CTRL/STAT:");
break; break;
case 0x08: case 0x08:
if (RnW) if (RnW)
fprintf(stderr, "RESEND :"); fprintf(stderr, "RESEND :");
else else
fprintf(stderr, "DP_SELECT:"); fprintf(stderr, "DP_SELECT:");
break; break;
case 0x0c: fprintf(stderr, "DP_RDBUFF:");
case 0x0c:
fprintf(stderr, "DP_RDBUFF:");
break; break;
default: fprintf(stderr, "Unknown %02x :", addr);
default:
fprintf(stderr, "Unknown %02x :", addr);
} }
} else { } else {
fprintf(stderr, "AP 0x%02x ", addr >> 8); fprintf(stderr, "AP 0x%02x ", addr >> 8);
switch (addr & 0xff) { switch (addr & 0xff) {
case 0x00: fprintf(stderr, "CSW :"); case 0x00:
fprintf(stderr, "CSW :");
break; break;
case 0x04: fprintf(stderr, "TAR :");
case 0x04:
fprintf(stderr, "TAR :");
break; break;
case 0x0c: fprintf(stderr, "DRW :");
case 0x0c:
fprintf(stderr, "DRW :");
break; break;
case 0x10: fprintf(stderr, "DB0 :");
case 0x10:
fprintf(stderr, "DB0 :");
break; break;
case 0x14: fprintf(stderr, "DB1 :");
case 0x14:
fprintf(stderr, "DB1 :");
break; break;
case 0x18: fprintf(stderr, "DB2 :");
case 0x18:
fprintf(stderr, "DB2 :");
break; break;
case 0x1c: fprintf(stderr, "DB3 :");
case 0x1c:
fprintf(stderr, "DB3 :");
break; break;
case 0xf8: fprintf(stderr, "BASE :");
case 0xf8:
fprintf(stderr, "BASE :");
break; break;
case 0xf4: fprintf(stderr, "CFG :");
case 0xf4:
fprintf(stderr, "CFG :");
break; break;
case 0xfc: fprintf(stderr, "IDR :");
case 0xfc:
fprintf(stderr, "IDR :");
break; break;
default: fprintf(stderr, "RSVD%02x:", addr & 0xff);
default:
fprintf(stderr, "RSVD%02x:", addr & 0xff);
} }
} }
} }
@ -515,17 +606,16 @@ uint32_t adiv5_dp_read(ADIv5_DP_t *dp, uint16_t addr)
uint32_t adiv5_dp_error(ADIv5_DP_t *dp) uint32_t adiv5_dp_error(ADIv5_DP_t *dp)
{ {
uint32_t ret = dp->error(dp); uint32_t ret = dp->error(dp);
DEBUG_TARGET( "DP Error 0x%08" PRIx32 "\n", ret); DEBUG_TARGET("DP Error 0x%08" PRIx32 "\n", ret);
return ret; return ret;
} }
uint32_t adiv5_dp_low_access(struct ADIv5_DP_s *dp, uint8_t RnW, uint32_t adiv5_dp_low_access(struct ADIv5_DP_s *dp, uint8_t RnW, uint16_t addr, uint32_t value)
uint16_t addr, uint32_t value)
{ {
uint32_t ret = dp->low_access(dp, RnW, addr, value); uint32_t ret = dp->low_access(dp, RnW, addr, value);
if (cl_debuglevel & BMP_DEBUG_TARGET) { if (cl_debuglevel & BMP_DEBUG_TARGET) {
ap_decode_access(addr, RnW); ap_decode_access(addr, RnW);
fprintf(stderr, " 0x%08" PRIx32 "\n", (RnW)? ret : value); fprintf(stderr, " 0x%08" PRIx32 "\n", RnW ? ret : value);
} }
return ret; return ret;
} }
@ -553,34 +643,40 @@ void adiv5_mem_read(ADIv5_AP_t *ap, void *dest, uint32_t src, size_t len)
{ {
ap->dp->mem_read(ap, dest, src, len); ap->dp->mem_read(ap, dest, src, len);
if (cl_debuglevel & BMP_DEBUG_TARGET) { if (cl_debuglevel & BMP_DEBUG_TARGET) {
fprintf(stderr, "ap_memread @ %" PRIx32 " len %" PRIx32 ":", fprintf(stderr, "ap_memread @ %" PRIx32 " len %" PRIx32 ":", src, (uint32_t)len);
src, (uint32_t)len); uint8_t *p = (uint8_t *)dest;
uint8_t *p = (uint8_t *) dest;
unsigned int i = len; unsigned int i = len;
if (i > 16) if (i > 16)
i = 16; i = 16;
while (i--) while (i--)
fprintf(stderr, " %02x", *p++); fprintf(stderr, " %02x", *p++);
if (len > 16) if (len > 16)
fprintf(stderr, " ..."); fprintf(stderr, " ...");
fprintf(stderr, "\n"); fprintf(stderr, "\n");
} }
return; return;
} }
void adiv5_mem_write_sized( ADIv5_AP_t *ap, uint32_t dest, const void *src, void adiv5_mem_write_sized(ADIv5_AP_t *ap, uint32_t dest, const void *src, size_t len, enum align align)
size_t len, enum align align)
{ {
if (cl_debuglevel & BMP_DEBUG_TARGET) { if (cl_debuglevel & BMP_DEBUG_TARGET) {
fprintf(stderr, "ap_mem_write_sized @ %" PRIx32 " len %" PRIx32 fprintf(stderr, "ap_mem_write_sized @ %" PRIx32 " len %" PRIx32 ", align %d:", dest, (uint32_t)len, 1 << align);
", align %d:", dest, (uint32_t)len, 1 << align);
uint8_t *p = (uint8_t *) src; uint8_t *p = (uint8_t *)src;
unsigned int i = len; unsigned int i = len;
if (i > 16) if (i > 16)
i = 16; i = 16;
while (i--) while (i--)
fprintf(stderr, " %02x", *p++); fprintf(stderr, " %02x", *p++);
if (len > 16) if (len > 16)
fprintf(stderr, " ..."); fprintf(stderr, " ...");
fprintf(stderr, "\n"); fprintf(stderr, "\n");
} }
return ap->dp->mem_write_sized(ap, dest, src, len, align); return ap->dp->mem_write_sized(ap, dest, src, len, align);