cb710: add missing parenthesis
[linux-2.6.git] / drivers / misc / cb710 / debug.c
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 #include <linux/slab.h>
14
15 #define CB710_REG_COUNT         0x80
16
17 static const u16 allow[CB710_REG_COUNT/16] = {
18         0xFFF0, 0xFFFF, 0xFFFF, 0xFFFF,
19         0xFFF0, 0xFFFF, 0xFFFF, 0xFFFF,
20 };
21 static const char *const prefix[ARRAY_SIZE(allow)] = {
22         "MMC", "MMC", "MMC", "MMC",
23         "MS?", "MS?", "SM?", "SM?"
24 };
25
26 static inline int allow_reg_read(unsigned block, unsigned offset, unsigned bits)
27 {
28         unsigned mask = (1 << bits/8) - 1;
29         offset *= bits/8;
30         return ((allow[block] >> offset) & mask) == mask;
31 }
32
33 #define CB710_READ_REGS_TEMPLATE(t)                                     \
34 static void cb710_read_regs_##t(void __iomem *iobase,                   \
35         u##t *reg, unsigned select)                                     \
36 {                                                                       \
37         unsigned i, j;                                                  \
38                                                                         \
39         for (i = 0; i < ARRAY_SIZE(allow); ++i, reg += 16/(t/8)) {      \
40                 if (!(select & (1 << i)))                                       \
41                         continue;                                       \
42                                                                         \
43                 for (j = 0; j < 0x10/(t/8); ++j) {                      \
44                         if (!allow_reg_read(i, j, t))                   \
45                                 continue;                               \
46                         reg[j] = ioread##t(iobase                       \
47                                 + (i << 4) + (j * (t/8)));              \
48                 }                                                       \
49         }                                                               \
50 }
51
52 static const char cb710_regf_8[] = "%02X";
53 static const char cb710_regf_16[] = "%04X";
54 static const char cb710_regf_32[] = "%08X";
55 static const char cb710_xes[] = "xxxxxxxx";
56
57 #define CB710_DUMP_REGS_TEMPLATE(t)                                     \
58 static void cb710_dump_regs_##t(struct device *dev,                     \
59         const u##t *reg, unsigned select)                               \
60 {                                                                       \
61         const char *const xp = &cb710_xes[8 - t/4];                     \
62         const char *const format = cb710_regf_##t;                      \
63                                                                         \
64         char msg[100], *p;                                              \
65         unsigned i, j;                                                  \
66                                                                         \
67         for (i = 0; i < ARRAY_SIZE(allow); ++i, reg += 16/(t/8)) {      \
68                 if (!(select & (1 << i)))                               \
69                         continue;                                       \
70                 p = msg;                                                \
71                 for (j = 0; j < 0x10/(t/8); ++j) {                      \
72                         *p++ = ' ';                                     \
73                         if (j == 8/(t/8))                               \
74                                 *p++ = ' ';                             \
75                         if (allow_reg_read(i, j, t))                    \
76                                 p += sprintf(p, format, reg[j]);        \
77                         else                                            \
78                                 p += sprintf(p, "%s", xp);              \
79                 }                                                       \
80                 dev_dbg(dev, "%s 0x%02X %s\n", prefix[i], i << 4, msg); \
81         }                                                               \
82 }
83
84 #define CB710_READ_AND_DUMP_REGS_TEMPLATE(t)                            \
85 static void cb710_read_and_dump_regs_##t(struct cb710_chip *chip,       \
86         unsigned select)                                                \
87 {                                                                       \
88         u##t regs[CB710_REG_COUNT/sizeof(u##t)];                        \
89                                                                         \
90         memset(&regs, 0, sizeof(regs));                                 \
91         cb710_read_regs_##t(chip->iobase, regs, select);                \
92         cb710_dump_regs_##t(cb710_chip_dev(chip), regs, select);        \
93 }
94
95 #define CB710_REG_ACCESS_TEMPLATES(t)           \
96   CB710_READ_REGS_TEMPLATE(t)                   \
97   CB710_DUMP_REGS_TEMPLATE(t)                   \
98   CB710_READ_AND_DUMP_REGS_TEMPLATE(t)
99
100 CB710_REG_ACCESS_TEMPLATES(8)
101 CB710_REG_ACCESS_TEMPLATES(16)
102 CB710_REG_ACCESS_TEMPLATES(32)
103
104 void cb710_dump_regs(struct cb710_chip *chip, unsigned select)
105 {
106         if (!(select & CB710_DUMP_REGS_MASK))
107                 select = CB710_DUMP_REGS_ALL;
108         if (!(select & CB710_DUMP_ACCESS_MASK))
109                 select |= CB710_DUMP_ACCESS_8;
110
111         if (select & CB710_DUMP_ACCESS_32)
112                 cb710_read_and_dump_regs_32(chip, select);
113         if (select & CB710_DUMP_ACCESS_16)
114                 cb710_read_and_dump_regs_16(chip, select);
115         if (select & CB710_DUMP_ACCESS_8)
116                 cb710_read_and_dump_regs_8(chip, select);
117 }
118 EXPORT_SYMBOL_GPL(cb710_dump_regs);
119