2013-04-17 11:35:14 +00:00
|
|
|
#include <common.h>
|
2013-07-10 07:27:06 +00:00
|
|
|
#include <errno.h>
|
2014-08-03 15:51:38 +00:00
|
|
|
#include <abort.h>
|
2013-04-17 11:35:14 +00:00
|
|
|
|
|
|
|
#define DISP_LINE_LEN 16
|
|
|
|
|
2013-03-01 10:59:57 +00:00
|
|
|
int memory_display(const void *addr, loff_t offs, unsigned nbytes, int size, int swab)
|
2013-04-17 11:35:14 +00:00
|
|
|
{
|
2015-05-27 08:36:46 +00:00
|
|
|
unsigned long linebytes, i;
|
|
|
|
unsigned char *cp;
|
2013-04-17 11:35:14 +00:00
|
|
|
|
|
|
|
/* Print the lines.
|
|
|
|
*
|
|
|
|
* We buffer all read data, so we can make sure data is read only
|
|
|
|
* once, and all accesses are with the specified bus width.
|
|
|
|
*/
|
|
|
|
do {
|
2015-05-27 08:36:46 +00:00
|
|
|
unsigned char linebuf[DISP_LINE_LEN];
|
2015-05-27 09:10:18 +00:00
|
|
|
uint64_t *ullp = (uint64_t *)linebuf;
|
2015-05-27 08:36:46 +00:00
|
|
|
uint32_t *uip = (uint32_t *)linebuf;
|
|
|
|
uint16_t *usp = (uint16_t *)linebuf;
|
|
|
|
uint8_t *ucp = (uint8_t *)linebuf;
|
2013-04-17 11:35:14 +00:00
|
|
|
unsigned count = 52;
|
|
|
|
|
|
|
|
printf("%08llx:", offs);
|
|
|
|
linebytes = (nbytes > DISP_LINE_LEN) ? DISP_LINE_LEN : nbytes;
|
|
|
|
|
|
|
|
for (i = 0; i < linebytes; i += size) {
|
2015-05-27 09:10:18 +00:00
|
|
|
if (size == 8) {
|
|
|
|
uint64_t res;
|
|
|
|
data_abort_mask();
|
|
|
|
res = *((uint64_t *)addr);
|
|
|
|
if (swab)
|
|
|
|
res = __swab64(res);
|
|
|
|
if (data_abort_unmask()) {
|
|
|
|
res = 0xffffffffffffffffULL;
|
|
|
|
count -= printf(" xxxxxxxxxxxxxxxx");
|
|
|
|
} else {
|
|
|
|
count -= printf(" %016llx", res);
|
|
|
|
}
|
|
|
|
*ullp++ = res;
|
|
|
|
} else if (size == 4) {
|
2015-05-27 08:36:46 +00:00
|
|
|
uint32_t res;
|
2014-08-03 15:51:38 +00:00
|
|
|
data_abort_mask();
|
2015-05-27 08:36:46 +00:00
|
|
|
res = *((uint32_t *)addr);
|
2013-04-17 11:35:14 +00:00
|
|
|
if (swab)
|
|
|
|
res = __swab32(res);
|
2014-08-03 15:51:38 +00:00
|
|
|
if (data_abort_unmask()) {
|
|
|
|
res = 0xffffffff;
|
|
|
|
count -= printf(" xxxxxxxx");
|
|
|
|
} else {
|
|
|
|
count -= printf(" %08x", res);
|
|
|
|
}
|
|
|
|
*uip++ = res;
|
2013-04-17 11:35:14 +00:00
|
|
|
} else if (size == 2) {
|
2015-05-27 08:36:46 +00:00
|
|
|
uint16_t res;
|
2014-08-03 15:51:38 +00:00
|
|
|
data_abort_mask();
|
2015-05-27 08:36:46 +00:00
|
|
|
res = *((uint16_t *)addr);
|
2013-04-17 11:35:14 +00:00
|
|
|
if (swab)
|
|
|
|
res = __swab16(res);
|
2014-08-03 15:51:38 +00:00
|
|
|
if (data_abort_unmask()) {
|
|
|
|
res = 0xffff;
|
|
|
|
count -= printf(" xxxx");
|
|
|
|
} else {
|
|
|
|
count -= printf(" %04x", res);
|
|
|
|
}
|
|
|
|
*usp++ = res;
|
2013-04-17 11:35:14 +00:00
|
|
|
} else {
|
2015-05-27 08:36:46 +00:00
|
|
|
uint8_t res;
|
2014-08-03 15:51:38 +00:00
|
|
|
data_abort_mask();
|
2015-05-27 08:36:46 +00:00
|
|
|
res = *((uint8_t *)addr);
|
2014-08-03 15:51:38 +00:00
|
|
|
if (data_abort_unmask()) {
|
|
|
|
res = 0xff;
|
|
|
|
count -= printf(" xx");
|
|
|
|
} else {
|
|
|
|
count -= printf(" %02x", res);
|
|
|
|
}
|
|
|
|
*ucp++ = res;
|
2013-04-17 11:35:14 +00:00
|
|
|
}
|
|
|
|
addr += size;
|
|
|
|
offs += size;
|
|
|
|
}
|
|
|
|
|
|
|
|
while (count--)
|
|
|
|
putchar(' ');
|
|
|
|
|
2015-05-27 08:36:46 +00:00
|
|
|
cp = linebuf;
|
2013-04-17 11:35:14 +00:00
|
|
|
for (i = 0; i < linebytes; i++) {
|
|
|
|
if ((*cp < 0x20) || (*cp > 0x7e))
|
|
|
|
putchar('.');
|
|
|
|
else
|
|
|
|
printf("%c", *cp);
|
|
|
|
cp++;
|
|
|
|
}
|
|
|
|
|
|
|
|
putchar('\n');
|
|
|
|
nbytes -= linebytes;
|
|
|
|
if (ctrlc())
|
|
|
|
return -EINTR;
|
|
|
|
} while (nbytes > 0);
|
|
|
|
|
|
|
|
return 0;
|
|
|
|
}
|