X-Git-Url: http://cloudbase.mooo.com/gitweb/z180-stamp.git/blobdiff_plain/92b46605a20b89d566a81811b9da7a0097b0d950..cdc4625b124f725fbc9462d5592d1d3be2aa613a:/avr/debug.c diff --git a/avr/debug.c b/avr/debug.c index 620eb4d..251ef26 100644 --- a/avr/debug.c +++ b/avr/debug.c @@ -1,123 +1,75 @@ +/* + * (C) Copyright 2014 Leo C. + * + * SPDX-License-Identifier: GPL-2.0+ + */ + #include "common.h" #include +#include #include #include #include "command.h" +#include "print-utils.h" #include "debug.h" /* * Debugging */ -#ifdef DEBUG - - -static void print_blanks(uint_fast8_t count) -{ - while(count--) - putchar(' '); -} +#ifdef DEBUG -void dump_ram(const uint8_t *startaddr, int len, char *title) -{ - 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; - - printf_P(PSTR(" %.4x:"), (size_t) addr); - print_blanks(3 * pre); - for (i = pre; i < llen; i++) - printf_P(PSTR(" %.2x"), addr[i]); - print_blanks(3 * (16 - i + 1) + pre); - for (i = pre; i < llen; i++) - printf_P(PSTR("%c"), isprint(addr[i]) ? addr[i] : '.'); - putchar('\n'); - - pre = 0; - addr += 16; - len -= llen; - } -} +#if 0 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:"); } +#endif -/* TODO: combine with dump_ram() */ -void dump_eep(const uint8_t *addr, unsigned int len) -{ - uint_fast8_t i; - uint8_t buf[16]; - - printf_P(PSTR("eeprom dump:")); - while (len) { - printf_P(PSTR("\n 0x%.4x:"), (unsigned int) addr); - for (i = 0; i<16; i++) - buf[i] = eeprom_read_byte(addr + i); - for (i = 0; i<16; i++) - printf_P(PSTR(" %.2x"), buf[i]); - printf_P(PSTR(" ")); - for (i = 0; i<16; i++) - printf_P(PSTR("%c"), isprint(buf[i]) ? buf[i] : '.'); - - addr += 16; - len -= len > 16 ? 16 : len; - } - putchar('\n'); -} /* - * EEPROM Display + * Memory Display * md addr {len} */ -int do_dump_eep(cmd_tbl_t *cmdtp, int flag, int argc, char * const argv[]) +command_ret_t do_dump_mem(cmd_tbl_t *cmdtp, int flag, int argc, char * const argv[]) { - const uint8_t *addr; - uint16_t length; + void (*readhow)(uint8_t *buf, uint32_t addr, uint8_t count); - (void) cmdtp; + (void) cmdtp; (void) flag; + if (argc < 2) + return CMD_RET_USAGE; - /* We use the last specified parameters, unless new ones are - * entered. - */ - addr = 0; - length = 128; + uint32_t addr; + uint32_t length = 128; - if (argc < 2) + if (strchr(argv[0],'r') != NULL) + readhow = ram_read_buf; + else if (strchr(argv[0],'e') != NULL) + readhow = eeprom_read_buf; + else return CMD_RET_USAGE; - if ((flag & CMD_FLAG_REPEAT) == 0) { - /* Address is specified since argc > 1 */ - addr = (const uint8_t *) (size_t) strtoul(argv[1], NULL, 16); + /* Address is specified since argc > 1 */ + addr = strtoul(argv[1], NULL, 16); - /* If another parameter, it is the length to display. */ - if (argc > 2) - length = (uint16_t) strtoul(argv[2], NULL, 16); - } + /* If another parameter, it is the length to display. */ + if (argc > 2) + length = (uint16_t) strtoul(argv[2], NULL, 16); /* Print the lines. */ - dump_eep(addr, length); + dump_mem(addr, addr, length, readhow, NULL); - return 0; + return CMD_RET_SUCCESS; } -int do_eep_cp(cmd_tbl_t *cmdtp, int flag, int argc, char * const argv[]) +command_ret_t do_eep_cp(cmd_tbl_t *cmdtp, int flag, int argc, char * const argv[]) { uint16_t src, dest, count; int_fast8_t step; @@ -134,19 +86,19 @@ int do_eep_cp(cmd_tbl_t *cmdtp, int flag, int argc, char * const argv[]) if (src > E2END) { debug("src > EEPROM size: 0x%04x\n", src); - return 1; + return CMD_RET_FAILURE; } if (dest > E2END) { debug("dest > EEPROM size: 0x%04x\n", dest); - return 1; + return CMD_RET_FAILURE; } if (count > E2END+1) { debug("count > EEPROM size: 0x%04x\n", count); - return 1; + return CMD_RET_FAILURE; } if (count == 0) { - debug("Zero length ???\n"); - return 1; + debug("Zero length?\n"); + return CMD_RET_FAILURE; } if (dest > src) { @@ -164,7 +116,54 @@ int do_eep_cp(cmd_tbl_t *cmdtp, int flag, int argc, char * const argv[]) dest += step; } - return 0; + return CMD_RET_SUCCESS; } -#endif /* DEBUG */ + +/*------------------------------------------------------------------------------*/ + +#if 1 + +struct __freelist { + size_t sz; + struct __freelist *nx; +}; + +extern char *__brkval; /* first location not yet allocated */ +extern struct __freelist *__flp; /* freelist pointer (head of freelist) */ + +#define STACK_POINTER() ((char *)AVR_STACK_POINTER_REG) + +void +printfreelist(const char * title) +{ + struct __freelist *fp1; + int i; + unsigned int freesum = 0; + +/* TODO: printf_P */ + + if (!__flp) { + printf("%s no free list\n", title ? title : ""); + } else { + printf("Free list: %s\n", title ? title : ""); + for (i = 0, fp1 = __flp; fp1; i++, fp1 = fp1->nx) { + printf(" entry %d @ %04x: size %4u, next ", + i, (size_t)fp1, fp1->sz); + if (fp1->nx) + printf("%04x\n", (size_t)fp1->nx); + else + printf("NULL\n"); + freesum += fp1->sz; + } + } + + freesum += (size_t) STACK_POINTER() - __malloc_margin - (size_t) __brkval; + + printf("SP: %04x, __brkval: %04x, Total free: %04u\n", + (size_t) STACK_POINTER(), (size_t) __brkval, freesum); +} + +#endif + +#endif /* DEBUG */