You can not select more than 25 topics
Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
100 lines
2.6 KiB
100 lines
2.6 KiB
/* |
|
* 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; |
|
}
|
|
|