Loading...
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
16static const u16 allow[CB710_REG_COUNT/16] = {
17 0xFFF0, 0xFFFF, 0xFFFF, 0xFFFF,
18 0xFFF0, 0xFFFF, 0xFFFF, 0xFFFF,
19};
20static const char *const prefix[ARRAY_SIZE(allow)] = {
21 "MMC", "MMC", "MMC", "MMC",
22 "MS?", "MS?", "SM?", "SM?"
23};
24
25static 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) \
33static 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
51static const char cb710_regf_8[] = "%02X";
52static const char cb710_regf_16[] = "%04X";
53static const char cb710_regf_32[] = "%08X";
54static const char cb710_xes[] = "xxxxxxxx";
55
56#define CB710_DUMP_REGS_TEMPLATE(t) \
57static 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) \
84static 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(®s, 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
99CB710_REG_ACCESS_TEMPLATES(8)
100CB710_REG_ACCESS_TEMPLATES(16)
101CB710_REG_ACCESS_TEMPLATES(32)
102
103void cb710_dump_regs(struct cb710_chip *chip, unsigned select)
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}
117EXPORT_SYMBOL_GPL(cb710_dump_regs);
118
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
13static const u16 allow[CB710_REG_COUNT/16] = {
14 0xFFF0, 0xFFFF, 0xFFFF, 0xFFFF,
15 0xFFF0, 0xFFFF, 0xFFFF, 0xFFFF,
16};
17static const char *const prefix[ARRAY_SIZE(allow)] = {
18 "MMC", "MMC", "MMC", "MMC",
19 "MS?", "MS?", "SM?", "SM?"
20};
21
22static 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) \
30static 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
48static const char cb710_regf_8[] = "%02X";
49static const char cb710_regf_16[] = "%04X";
50static const char cb710_regf_32[] = "%08X";
51static const char cb710_xes[] = "xxxxxxxx";
52
53#define CB710_DUMP_REGS_TEMPLATE(t) \
54static 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) \
81static 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
96CB710_REG_ACCESS_TEMPLATES(8)
97CB710_REG_ACCESS_TEMPLATES(16)
98CB710_REG_ACCESS_TEMPLATES(32)
99
100void 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}
114EXPORT_SYMBOL_GPL(cb710_dump_regs);
115