CHIP-linux-libre/drivers/fmc/fmc-dump.c

/*
 * Copyright (C) 2013 CERN (www.cern.ch)
 * Author: Alessandro Rubini <rubini@gnudd.com>
 *
 * Released according to the GNU GPL, version 2 or any later version.
 *
 * This work is part of the White Rabbit project, a research effort led
 * by CERN, the European Institute for Nuclear Research.
 */
#include <linux/kernel.h>
#include <linux/moduleparam.h>
#include <linux/device.h>
#include <linux/fmc.h>
#include <linux/fmc-sdb.h>

static int fmc_must_dump_eeprom;
module_param_named(dump_eeprom, fmc_must_dump_eeprom, int, 0644);
static int fmc_must_dump_sdb;
module_param_named(dump_sdb, fmc_must_dump_sdb, int, 0644);

#define LINELEN 16

/* Dumping 8k takes oh so much: avoid duplicate lines */
static const uint8_t *dump_line(int addr, const uint8_t *line,
				const uint8_t *prev)
{
	int i;

	if (!prev || memcmp(line, prev, LINELEN)) {
		pr_info("%04x: ", addr);
		for (i = 0; i < LINELEN; ) {
			printk(KERN_CONT "%02x", line[i]);
			i++;
			printk(i & 3 ? " " : i & (LINELEN - 1) ? "  " : "\n");
		}
		return line;
	}
	/* repeated line */
	if (line == prev + LINELEN)
		pr_info("[...]\n");
	return prev;
}

void fmc_dump_eeprom(const struct fmc_device *fmc)
{
	const uint8_t *line, *prev;
	int i;

	if (!fmc_must_dump_eeprom)
		return;

	pr_info("FMC: %s (%s), slot %i, device %s\n", dev_name(fmc->hwdev),
		fmc->carrier_name, fmc->slot_id, dev_name(&fmc->dev));
	pr_info("FMC: dumping eeprom 0x%x (%i) bytes\n", fmc->eeprom_len,
	       fmc->eeprom_len);

	line = fmc->eeprom;
	prev = NULL;
	for (i = 0; i < fmc->eeprom_len; i += LINELEN, line += LINELEN)
		prev = dump_line(i, line, prev);
}

void fmc_dump_sdb(const struct fmc_device *fmc)
{
	const uint8_t *line, *prev;
	int i, len;

	if (!fmc->sdb)
		return;
	if (!fmc_must_dump_sdb)
		return;

	/* If the argument is not-zero, do simple dump (== show) */
	if (fmc_must_dump_sdb > 0)
		fmc_show_sdb_tree(fmc);

	if (fmc_must_dump_sdb == 1)
		return;

	/* If bigger than 1, dump it seriously, to help debugging */

	/*
	 * Here we should really use libsdbfs (which is designed to
	 * work in kernel space as well) , but it doesn't support
	 * directories yet, and it requires better intergration (it
	 * should be used instead of fmc-specific code).
	 *
	 * So, lazily, just dump the top-level array
	 */
	pr_info("FMC: %s (%s), slot %i, device %s\n", dev_name(fmc->hwdev),
		fmc->carrier_name, fmc->slot_id, dev_name(&fmc->dev));
	pr_info("FMC: poor dump of sdb first level:\n");

	len = fmc->sdb->len * sizeof(union sdb_record);
	line = (void *)fmc->sdb->record;
	prev = NULL;
	for (i = 0; i < len; i += LINELEN, line += LINELEN)
		prev = dump_line(i, line, prev);
	return;
}