1/*
2 * Copyright (C) 2013 CERN (www.cern.ch)
3 * Author: Alessandro Rubini <rubini@gnudd.com>
4 *
5 * Released according to the GNU GPL, version 2 or any later version.
6 *
7 * This work is part of the White Rabbit project, a research effort led
8 * by CERN, the European Institute for Nuclear Research.
9 */
10#include <linux/kernel.h>
11#include <linux/moduleparam.h>
12#include <linux/device.h>
13#include <linux/fmc.h>
14#include <linux/fmc-sdb.h>
15
16static int fmc_must_dump_eeprom;
17module_param_named(dump_eeprom, fmc_must_dump_eeprom, int, 0644);
18
19#define LINELEN 16
20
21/* Dumping 8k takes oh so much: avoid duplicate lines */
22static const uint8_t *dump_line(int addr, const uint8_t *line,
23 const uint8_t *prev)
24{
25 int i;
26
27 if (!prev || memcmp(line, prev, LINELEN)) {
28 pr_info("%04x: ", addr);
29 for (i = 0; i < LINELEN; ) {
30 printk(KERN_CONT "%02x", line[i]);
31 i++;
32 printk(i & 3 ? " " : i & (LINELEN - 1) ? " " : "\n");
33 }
34 return line;
35 }
36 /* repeated line */
37 if (line == prev + LINELEN)
38 pr_info("[...]\n");
39 return prev;
40}
41
42void fmc_dump_eeprom(const struct fmc_device *fmc)
43{
44 const uint8_t *line, *prev;
45 int i;
46
47 if (!fmc_must_dump_eeprom)
48 return;
49
50 pr_info("FMC: %s (%s), slot %i, device %s\n", dev_name(fmc->hwdev),
51 fmc->carrier_name, fmc->slot_id, dev_name(&fmc->dev));
52 pr_info("FMC: dumping eeprom 0x%x (%i) bytes\n", fmc->eeprom_len,
53 fmc->eeprom_len);
54
55 line = fmc->eeprom;
56 prev = NULL;
57 for (i = 0; i < fmc->eeprom_len; i += LINELEN, line += LINELEN)
58 prev = dump_line(i, line, prev);
59}
60