Blame view

drivers/fmc/fmc-dump.c 2.58 KB
77864f2e0   Alessandro Rubini   FMC: add core bus...
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
  /*
   * 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) ? "  " : "
  ");
  		}
  		return line;
  	}
  	/* repeated line */
  	if (line == prev + LINELEN)
  		pr_info("[...]
  ");
  	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
  ", dev_name(fmc->hwdev),
  		fmc->carrier_name, fmc->slot_id, dev_name(&fmc->dev));
  	pr_info("FMC: dumping eeprom 0x%x (%i) bytes
  ", 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
  ", dev_name(fmc->hwdev),
  		fmc->carrier_name, fmc->slot_id, dev_name(&fmc->dev));
  	pr_info("FMC: poor dump of sdb first level:
  ");
  
  	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;
  }