/* * 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; }