drivers/fmc/fmc-dump.c

   1 /*
   2  * Copyright (C) 2013 CERN (www.cern.ch)
   3  * Author: Alessandro Rubini <[email protected]>
   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
  16 static int fmc_must_dump_eeprom;
  17 module_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 */
  22 static 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
  42 void 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 }