One dump_mem() for all memory types (avr eeprom and ram, z180 ram)

[z180-stamp.git] / avr / debug.c

diff --git a/avr/debug.c b/avr/debug.c
index 47b11b097cc5b51130f460eb760e5d4fd6564231..1940eb003d240db4fe3d6936d7ec83fe1a8191cc 100644 (file)
--- a/avr/debug.c
+++ b/avr/debug.c
@@ -5,77 +5,35 @@
 #include <avr/eeprom.h>
 
 #include "command.h"
+#include "print-utils.h"
 #include "debug.h"
-
 /*
  * Debugging
  */
+
 #ifdef DEBUG
 
-static void print_blanks(uint_fast8_t count)
-{
-       while(count--)
-               putchar(' ');
-}
 
-static uint8_t ram_read_byte(const uint8_t *p)
+void eeprom_read_buf(uint8_t *buf, uint32_t addr, uint8_t count)
 {
-       return *p;
+       eeprom_read_block((void *) buf, (const void *) (size_t) addr, count);
 }
 
-void dump_mem(const uint8_t *startaddr, int len,
-               uint8_t (*readfkt)(const uint8_t *), char *title)
+void ram_read_buf(uint8_t *buf, uint32_t addr, uint8_t count)
 {
-       uint8_t buf[16];
-       char *indent = NULL;
-       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);
-               indent = "    ";
-       }
-
-       while (len) {
-               if (len < 16)
-                       llen = len;
-
-               for (i = pre; i < llen; i++)
-                       buf[i] = readfkt(addr + i);
-
-               printf_P(PSTR("%s%04x:"),indent, 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;
-       }
+               while (count--)
+                       *buf++ = *(uint8_t *) (size_t) addr++;
 }
 
-void dump_eep(const uint8_t *addr, unsigned int len, char *title)
+
+void dump_eep(uint32_t addr, unsigned int len, char *title)
 {
-       dump_mem(addr, len, eeprom_read_byte, title);
+       dump_mem(addr, len, eeprom_read_buf, title);
 }
 
-void dump_ram(const uint8_t *addr, unsigned int len, char *title)
+void dump_ram(uint32_t addr, unsigned int len, char *title)
 {
-       dump_mem(addr, len, ram_read_byte, title);
+       dump_mem(addr, len, ram_read_buf, title);
 }
 
 
@@ -84,7 +42,7 @@ void dump_heap(void)
 {
        extern unsigned int __brkval;
 
-       dump_ram((uint8_t *) __malloc_heap_start,
+       dump_ram(__malloc_heap_start,
                __brkval - (unsigned int) __malloc_heap_start,
                "=== Heap:");
 }
@@ -97,27 +55,25 @@ void dump_heap(void)
  */
 command_ret_t do_dump_mem(cmd_tbl_t *cmdtp, int flag, int argc, char * const argv[])
 {
-//     static const uint8_t *addr;
-//     static uint16_t length = 128;
-       uint8_t (*readhow)(const uint8_t *);
+       void (*readhow)(uint8_t *buf, uint32_t addr, uint8_t count);
 
        (void) cmdtp; (void) flag;
 
        if (argc < 2)
                return CMD_RET_USAGE;
 
-       const uint8_t *addr;
-       uint16_t length = 128;
+       uint32_t addr;
+       uint32_t length = 128;
 
        if (strchr(argv[0],'r') != NULL)
-               readhow = ram_read_byte;
+               readhow = ram_read_buf;
        else if (strchr(argv[0],'e') != NULL)
-               readhow = eeprom_read_byte;
+               readhow = eeprom_read_buf;
        else
                return CMD_RET_USAGE;
 
        /* Address is specified since argc > 1 */
-       addr = (const uint8_t *) (size_t) strtoul(argv[1], NULL, 16);
+       addr =  strtoul(argv[1], NULL, 16);
 
        /* If another parameter, it is the length to display. */
        if (argc > 2)
@@ -227,4 +183,3 @@ printfreelist(const char * title)
 #endif
 
 #endif /* DEBUG */
-