-void dump_mem(const uint8_t *startaddr, int len,
- uint8_t (*readfkt)(const uint8_t *), char *title)
-{
- uint8_t buf[16];
- uint8_t llen = 16;
- uint8_t pre = (size_t) startaddr % 16;
- const uint8_t *addr = (uint8_t *) ((size_t) startaddr & ~0x0f);
- len += pre;
- uint8_t i;
-
- if (title && *title)
- printf_P(PSTR("%s\n"),title);
-
- while (len) {
- if (len < 16)
- llen = len;
-
- for (i = pre; i < llen; i++)
- buf[i] = readfkt(addr + i);
-
- printf_P(PSTR("%04x:"), addr);
- for (i = 0; i < llen; i++) {
- if ((i % 8) == 0)
- putchar(' ');
- if (i < pre)
- printf_P(PSTR(".. "));
- else
- printf_P(PSTR("%.2x "), buf[i]);
- }
- /* fill line with whitespace for nice ASCII print */
- print_blanks(3 * (16u - i) + (16u-i)/8 + 1 + pre);
- /* Print data in ASCII characters */
- for (i = pre; i < llen; i++)
- printf_P(PSTR("%c"), isprint(buf[i]) ? buf[i] : '.');
- putchar('\n');
-
- pre = 0;
- addr += 16;
- len -= llen;
- }
-}