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