Linux Kernel  3.7.1
 All Data Structures Namespaces Files Functions Variables Typedefs Enumerations Enumerator Macros Groups Pages
debug.c
Go to the documentation of this file.
1 /*
2  * cb710/debug.c
3  *
4  * Copyright by Michał Mirosław, 2008-2009
5  *
6  * This program is free software; you can redistribute it and/or modify
7  * it under the terms of the GNU General Public License version 2 as
8  * published by the Free Software Foundation.
9  */
10 #include <linux/cb710.h>
11 #include <linux/kernel.h>
12 #include <linux/module.h>
13 
14 #define CB710_REG_COUNT 0x80
15 
16 static const u16 allow[CB710_REG_COUNT/16] = {
17  0xFFF0, 0xFFFF, 0xFFFF, 0xFFFF,
18  0xFFF0, 0xFFFF, 0xFFFF, 0xFFFF,
19 };
20 static const char *const prefix[ARRAY_SIZE(allow)] = {
21  "MMC", "MMC", "MMC", "MMC",
22  "MS?", "MS?", "SM?", "SM?"
23 };
24 
25 static inline int allow_reg_read(unsigned block, unsigned offset, unsigned bits)
26 {
27  unsigned mask = (1 << bits/8) - 1;
28  offset *= bits/8;
29  return ((allow[block] >> offset) & mask) == mask;
30 }
31 
32 #define CB710_READ_REGS_TEMPLATE(t) \
33 static void cb710_read_regs_##t(void __iomem *iobase, \
34  u##t *reg, unsigned select) \
35 { \
36  unsigned i, j; \
37  \
38  for (i = 0; i < ARRAY_SIZE(allow); ++i, reg += 16/(t/8)) { \
39  if (!(select & (1 << i))) \
40  continue; \
41  \
42  for (j = 0; j < 0x10/(t/8); ++j) { \
43  if (!allow_reg_read(i, j, t)) \
44  continue; \
45  reg[j] = ioread##t(iobase \
46  + (i << 4) + (j * (t/8))); \
47  } \
48  } \
49 }
50 
51 static const char cb710_regf_8[] = "%02X";
52 static const char cb710_regf_16[] = "%04X";
53 static const char cb710_regf_32[] = "%08X";
54 static const char cb710_xes[] = "xxxxxxxx";
55 
56 #define CB710_DUMP_REGS_TEMPLATE(t) \
57 static void cb710_dump_regs_##t(struct device *dev, \
58  const u##t *reg, unsigned select) \
59 { \
60  const char *const xp = &cb710_xes[8 - t/4]; \
61  const char *const format = cb710_regf_##t; \
62  \
63  char msg[100], *p; \
64  unsigned i, j; \
65  \
66  for (i = 0; i < ARRAY_SIZE(allow); ++i, reg += 16/(t/8)) { \
67  if (!(select & (1 << i))) \
68  continue; \
69  p = msg; \
70  for (j = 0; j < 0x10/(t/8); ++j) { \
71  *p++ = ' '; \
72  if (j == 8/(t/8)) \
73  *p++ = ' '; \
74  if (allow_reg_read(i, j, t)) \
75  p += sprintf(p, format, reg[j]); \
76  else \
77  p += sprintf(p, "%s", xp); \
78  } \
79  dev_dbg(dev, "%s 0x%02X %s\n", prefix[i], i << 4, msg); \
80  } \
81 }
82 
83 #define CB710_READ_AND_DUMP_REGS_TEMPLATE(t) \
84 static void cb710_read_and_dump_regs_##t(struct cb710_chip *chip, \
85  unsigned select) \
86 { \
87  u##t regs[CB710_REG_COUNT/sizeof(u##t)]; \
88  \
89  memset(&regs, 0, sizeof(regs)); \
90  cb710_read_regs_##t(chip->iobase, regs, select); \
91  cb710_dump_regs_##t(cb710_chip_dev(chip), regs, select); \
92 }
93 
94 #define CB710_REG_ACCESS_TEMPLATES(t) \
95  CB710_READ_REGS_TEMPLATE(t) \
96  CB710_DUMP_REGS_TEMPLATE(t) \
97  CB710_READ_AND_DUMP_REGS_TEMPLATE(t)
98 
102 
104 {
105  if (!(select & CB710_DUMP_REGS_MASK))
106  select = CB710_DUMP_REGS_ALL;
107  if (!(select & CB710_DUMP_ACCESS_MASK))
108  select |= CB710_DUMP_ACCESS_8;
109 
110  if (select & CB710_DUMP_ACCESS_32)
111  cb710_read_and_dump_regs_32(chip, select);
112  if (select & CB710_DUMP_ACCESS_16)
113  cb710_read_and_dump_regs_16(chip, select);
114  if (select & CB710_DUMP_ACCESS_8)
115  cb710_read_and_dump_regs_8(chip, select);
116 }
118