Add copyright notice

[z180-stamp.git] / avr / print-utils.c

/*
 * (C) Copyright 2014 Leo C. <erbl259-lmu@yahoo.de>
 *
 * SPDX-License-Identifier:	GPL-2.0+
 */

#include "common.h"
#include <stdio.h>
#include <ctype.h>
#include "con-utils.h"
#include "print-utils.h"

void print_blanks(uint_fast8_t count)
{
	while(count--)
		putchar(' ');
}


void eeprom_read_buf(uint8_t *buf, uint32_t addr, uint8_t count)
{
	eeprom_read_block((void *) buf, (const void *) (size_t) addr, count);
}

void ram_read_buf(uint8_t *buf, uint32_t addr, uint8_t count)
{
		while (count--)
			*buf++ = *(uint8_t *) (size_t) addr++;
}

int dump_mem(uint32_t address, uint32_t offset, uint32_t len,
		void (*readfkt)(uint8_t *, uint32_t, uint8_t), char *title)
{
	uint8_t buf[16];
	char *indent = NULL;
	uint8_t llen = 16;
	uint8_t pre = offset % 16;
	offset = offset & ~0x0f;
	len += pre;
	uint8_t i;

	if (title && *title) {
		printf_P(PSTR("%s\n"),title);
		indent = "    ";
	}

	while (len) {
		if (len < 16)
			llen = len;
		readfkt(buf, address, llen - pre);

		printf_P(PSTR("%s%.5lx:"),indent, offset);
		for (i = 0; i < llen; i++) {
			if ((i % 8) == 0)
				putchar(' ');
			if (i < pre)
				printf_P(PSTR(".. "));
			else
				printf_P(PSTR("%.2x "), buf[i-pre]);
		}
		/* 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-pre]) ? buf[i-pre] : '.');
		putchar('\n');

		address += llen - pre;
		offset += 16;
		pre = 0;
		len -= llen;

		if (ctrlc())
			return -1;
	}
	return 0;
}

void dump_eep(uint32_t addr, unsigned int len, char *title)
{
	dump_mem(addr, addr, len, eeprom_read_buf, title);
}

void dump_ram(uint8_t *addr, size_t offset, unsigned int len, char *title)
{
	dump_mem((uint32_t) (size_t) addr, offset, len, ram_read_buf, title);
}