misc/cb710/debug.c

0001 // SPDX-License-Identifier: GPL-2.0-only
0002 /*
0003  *  cb710/debug.c
0004  *
0005  *  Copyright by Michał Mirosław, 2008-2009
0006  */
0007 #include <linux/cb710.h>
0008 #include <linux/kernel.h>
0009 #include <linux/module.h>
0010
0011 #define CB710_REG_COUNT     0x80
0012
0013 static const u16 allow[CB710_REG_COUNT/16] = {
0014     0xFFF0, 0xFFFF, 0xFFFF, 0xFFFF,
0015     0xFFF0, 0xFFFF, 0xFFFF, 0xFFFF,
0016 };
0017 static const char *const prefix[ARRAY_SIZE(allow)] = {
0018     "MMC", "MMC", "MMC", "MMC",
0019     "MS?", "MS?", "SM?", "SM?"
0020 };
0021
0022 static inline int allow_reg_read(unsigned block, unsigned offset, unsigned bits)
0023 {
0024     unsigned mask = (1 << bits/8) - 1;
0025     offset *= bits/8;
0026     return ((allow[block] >> offset) & mask) == mask;
0027 }
0028
0029 #define CB710_READ_REGS_TEMPLATE(t)                 \
0030 static void cb710_read_regs_##t(void __iomem *iobase,           \
0031     u##t *reg, unsigned select)                 \
0032 {                                   \
0033     unsigned i, j;                          \
0034                                     \
0035     for (i = 0; i < ARRAY_SIZE(allow); ++i, reg += 16/(t/8)) {  \
0036         if (!(select & (1 << i)))                   \
0037             continue;                   \
0038                                     \
0039         for (j = 0; j < 0x10/(t/8); ++j) {          \
0040             if (!allow_reg_read(i, j, t))           \
0041                 continue;               \
0042             reg[j] = ioread##t(iobase           \
0043                 + (i << 4) + (j * (t/8)));      \
0044         }                           \
0045     }                               \
0046 }
0047
0048 static const char cb710_regf_8[] = "%02X";
0049 static const char cb710_regf_16[] = "%04X";
0050 static const char cb710_regf_32[] = "%08X";
0051 static const char cb710_xes[] = "xxxxxxxx";
0052
0053 #define CB710_DUMP_REGS_TEMPLATE(t)                 \
0054 static void cb710_dump_regs_##t(struct device *dev,         \
0055     const u##t *reg, unsigned select)               \
0056 {                                   \
0057     const char *const xp = &cb710_xes[8 - t/4];         \
0058     const char *const format = cb710_regf_##t;          \
0059                                     \
0060     char msg[100], *p;                      \
0061     unsigned i, j;                          \
0062                                     \
0063     for (i = 0; i < ARRAY_SIZE(allow); ++i, reg += 16/(t/8)) {  \
0064         if (!(select & (1 << i)))               \
0065             continue;                   \
0066         p = msg;                        \
0067         for (j = 0; j < 0x10/(t/8); ++j) {          \
0068             *p++ = ' ';                 \
0069             if (j == 8/(t/8))               \
0070                 *p++ = ' ';             \
0071             if (allow_reg_read(i, j, t))            \
0072                 p += sprintf(p, format, reg[j]);    \
0073             else                        \
0074                 p += sprintf(p, "%s", xp);      \
0075         }                           \
0076         dev_dbg(dev, "%s 0x%02X %s\n", prefix[i], i << 4, msg); \
0077     }                               \
0078 }
0079
0080 #define CB710_READ_AND_DUMP_REGS_TEMPLATE(t)                \
0081 static void cb710_read_and_dump_regs_##t(struct cb710_chip *chip,   \
0082     unsigned select)                        \
0083 {                                   \
0084     u##t regs[CB710_REG_COUNT/sizeof(u##t)];            \
0085                                     \
0086     memset(&regs, 0, sizeof(regs));                 \
0087     cb710_read_regs_##t(chip->iobase, regs, select);        \
0088     cb710_dump_regs_##t(cb710_chip_dev(chip), regs, select);    \
0089 }
0090
0091 #define CB710_REG_ACCESS_TEMPLATES(t)       \
0092   CB710_READ_REGS_TEMPLATE(t)           \
0093   CB710_DUMP_REGS_TEMPLATE(t)           \
0094   CB710_READ_AND_DUMP_REGS_TEMPLATE(t)
0095
0096 CB710_REG_ACCESS_TEMPLATES(8)
0097 CB710_REG_ACCESS_TEMPLATES(16)
0098 CB710_REG_ACCESS_TEMPLATES(32)
0099
0100 void cb710_dump_regs(struct cb710_chip *chip, unsigned select)
0101 {
0102     if (!(select & CB710_DUMP_REGS_MASK))
0103         select = CB710_DUMP_REGS_ALL;
0104     if (!(select & CB710_DUMP_ACCESS_MASK))
0105         select |= CB710_DUMP_ACCESS_8;
0106
0107     if (select & CB710_DUMP_ACCESS_32)
0108         cb710_read_and_dump_regs_32(chip, select);
0109     if (select & CB710_DUMP_ACCESS_16)
0110         cb710_read_and_dump_regs_16(chip, select);
0111     if (select & CB710_DUMP_ACCESS_8)
0112         cb710_read_and_dump_regs_8(chip, select);
0113 }
0114 EXPORT_SYMBOL_GPL(cb710_dump_regs);
0115