+/*
+ * (C) Copyright 2014 Leo C. <erbl259-lmu@yahoo.de>
+ *
+ * SPDX-License-Identifier: GPL-2.0+
+ */
+
#include "common.h"
#include <stdlib.h>
#include <string.h>
#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)
-{
- return *p;
-}
-void dump_mem(const uint8_t *startaddr, int len,
- uint8_t (*readfkt)(const uint8_t *), char *title)
-{
- 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;
- }
-}
-
-void dump_eep(const uint8_t *addr, unsigned int len, char *title)
-{
- dump_mem(addr, len, eeprom_read_byte, title);
-}
-
-void dump_ram(const uint8_t *addr, unsigned int len, char *title)
-{
- dump_mem(addr, len, ram_read_byte, title);
-}
+#ifdef DEBUG
#if 0
{
extern unsigned int __brkval;
- dump_ram((uint8_t *) __malloc_heap_start,
+ dump_ram(__malloc_heap_start,
__brkval - (unsigned int) __malloc_heap_start,
"=== Heap:");
}
*/
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)
length = (uint16_t) strtoul(argv[2], NULL, 16);
/* Print the lines. */
- dump_mem(addr, length, readhow, NULL);
+ dump_mem(addr, addr, length, readhow, NULL);
return CMD_RET_SUCCESS;
}
return CMD_RET_SUCCESS;
}
-/*------------------------------------------------------------------------------*/
+/*------------------------------------------------------------------------------*/
-#if 0
+#if 1
struct __freelist {
size_t sz;
int i;
unsigned int freesum = 0;
+/* TODO: printf_P */
+
if (!__flp) {
printf("%s no free list\n", title ? title : "");
} else {
freesum += fp1->sz;
}
}
-
+
freesum += (size_t) STACK_POINTER() - __malloc_margin - (size_t) __brkval;
printf("SP: %04x, __brkval: %04x, Total free: %04u\n",
#endif
#endif /* DEBUG */
-