avr/print-utils.c

   1 /*
   2  * (C) Copyright 2014,2018 Leo C. <erbl259-lmu@yahoo.de>
   3  *
   4  * SPDX-License-Identifier:     GPL-2.0
   5  */
   6
   7 #include "common.h"
   8 #include <stdint.h>
   9 #include "con-utils.h"
  10 #include "print-utils.h"
  11
  12 void print_blanks(uint_fast8_t count)
  13 {
  14         while(count--)
  15                 putchar(' ');
  16 }
  17
  18
  19 ERRNUM eeprom_read_buf(uint8_t *buf, uint32_t addr, uint8_t count)
  20 {
  21         eeprom_read_block((void *) buf, (const void *) (size_t) addr, count);
  22         return ESUCCESS;
  23 }
  24
  25 ERRNUM ram_read_buf(uint8_t *buf, uint32_t addr, uint8_t count)
  26 {
  27         while (count--)
  28                 *buf++ = *(uint8_t *) (size_t) addr++;
  29         return ESUCCESS;
  30 }
  31
  32 ERRNUM flash_read_buf(uint8_t *buf, uint32_t addr, uint8_t count)
  33 {
  34         while (count--)
  35                 *buf++ = *(const __memx uint8_t *) (__uint24) addr++;
  36         return ESUCCESS;
  37 }
  38
  39 ERRNUM dump_mem(uint32_t address, uint32_t offset, uint32_t len,
  40                 ERRNUM (*readfkt)(uint8_t *, uint32_t, uint8_t), char *title)
  41 {
  42         uint8_t buf[16];
  43         uint8_t llen = 16;
  44         uint8_t pre = offset % 16;
  45         offset = offset & ~0x0f;
  46         len += pre;
  47         uint8_t i;
  48
  49         if (title && *title) {
  50                 printf_P(PSTR("%s\n"),title);
  51         }
  52
  53         while (len) {
  54                 if (len < 16)
  55                         llen = len;
  56                 ERRNUM err = readfkt(buf, address, llen - pre);
  57                 if (err != ESUCCESS)
  58                         return err;
  59
  60                 if (title)
  61                         print_blanks(4);
  62                 printf_P(PSTR("%.5lx:"),offset);
  63                 for (i = 0; i < llen; i++) {
  64                         if ((i % 8) == 0)
  65                                 putchar(' ');
  66                         if (i < pre)
  67                                 printf_P(PSTR(".. "));
  68                         else
  69                                 printf_P(PSTR("%.2x "), buf[i-pre]);
  70                 }
  71                 /* fill line with whitespace for nice ASCII print */
  72                 print_blanks(3 * (16u - i) + (16u-i)/8 + 1 + pre);
  73                 /* Print data in ASCII characters */
  74                 for (i = pre; i < llen; i++)
  75                         printf_P(PSTR("%c"), isprint(buf[i-pre]) ? buf[i-pre] : '.');
  76                 putchar('\n');
  77
  78                 address += llen - pre;
  79                 offset += 16;
  80                 pre = 0;
  81                 len -= llen;
  82
  83                 if (ctrlc())
  84                         return EINTR;
  85         }
  86         return ESUCCESS;
  87 }
  88
  89 void dump_eep(uint32_t addr, unsigned int len, char *title)
  90 {
  91         dump_mem(addr, addr, len, eeprom_read_buf, title);
  92 }
  93
  94 void dump_ram(uint8_t *addr, size_t offset, unsigned int len, char *title)
  95 {
  96         dump_mem((uint32_t) (size_t) addr, offset, len, ram_read_buf, title);
  97 }