// SPDX-License-Identifier: GPL-2.0-only /* * cb710/debug.c * * Copyright by MichaÅ‚ MirosÅ‚aw, 2008-2009 */ #include <linux/cb710.h> #include <linux/kernel.h> #include <linux/module.h> #define CB710_REG_COUNT 0x80 static const u16 allow[CB710_REG_COUNT/16] = { 0xFFF0, 0xFFFF, 0xFFFF, 0xFFFF, 0xFFF0, 0xFFFF, 0xFFFF, 0xFFFF, }; static const char *const prefix[ARRAY_SIZE(allow)] = { "MMC", "MMC", "MMC", "MMC", "MS?", "MS?", "SM?", "SM?" }; static inline int allow_reg_read(unsigned block, unsigned offset, unsigned bits) { unsigned mask = (1 << bits/8) - 1; offset *= bits/8; return ((allow[block] >> offset) & mask) == mask; } #define CB710_READ_REGS_TEMPLATE(t) \ static void cb710_read_regs_##t(void __iomem *iobase, \ u##t *reg, unsigned select) \ { \ unsigned i, j; \ \ for (i = 0; i < ARRAY_SIZE(allow); ++i, reg += 16/(t/8)) { \ if (!(select & (1 << i))) \ continue; \ \ for (j = 0; j < 0x10/(t/8); ++j) { \ if (!allow_reg_read(i, j, t)) \ continue; \ reg[j] = ioread##t(iobase \ + (i << 4) + (j * (t/8))); \ } \ } \ } static const char cb710_regf_8[] = "%02X"; static const char cb710_regf_16[] = "%04X"; static const char cb710_regf_32[] = "%08X"; static const char cb710_xes[] = "xxxxxxxx"; #define CB710_DUMP_REGS_TEMPLATE(t) \ static void cb710_dump_regs_##t(struct device *dev, \ const u##t *reg, unsigned select) \ { \ const char *const xp = &cb710_xes[8 - t/4]; \ const char *const format = cb710_regf_##t; \ \ char msg[100], *p; \ unsigned i, j; \ \ for (i = 0; i < ARRAY_SIZE(allow); ++i, reg += 16/(t/8)) { \ if (!(select & (1 << i))) \ continue; \ p = msg; \ for (j = 0; j < 0x10/(t/8); ++j) { \ *p++ = ' '; \ if (j == 8/(t/8)) \ *p++ = ' '; \ if (allow_reg_read(i, j, t)) \ p += sprintf(p, format, reg[j]); \ else \ p += sprintf(p, "%s", xp); \ } \ dev_dbg(dev, "%s 0x%02X %s\n", prefix[i], i << 4, msg); \ } \ } #define CB710_READ_AND_DUMP_REGS_TEMPLATE(t) \ static void cb710_read_and_dump_regs_##t(struct cb710_chip *chip, \ unsigned select) \ { \ u##t regs[CB710_REG_COUNT/sizeof(u##t)]; \ \ memset(®s, 0, sizeof(regs)); \ cb710_read_regs_##t(chip->iobase, regs, select); \ cb710_dump_regs_##t(cb710_chip_dev(chip), regs, select); \ } #define CB710_REG_ACCESS_TEMPLATES(t) \ CB710_READ_REGS_TEMPLATE(t) \ CB710_DUMP_REGS_TEMPLATE(t) \ CB710_READ_AND_DUMP_REGS_TEMPLATE(t) CB710_REG_ACCESS_TEMPLATES(8) CB710_REG_ACCESS_TEMPLATES(16) CB710_REG_ACCESS_TEMPLATES(32) void cb710_dump_regs(struct cb710_chip *chip, unsigned select) { if (!(select & CB710_DUMP_REGS_MASK)) select = CB710_DUMP_REGS_ALL; if (!(select & CB710_DUMP_ACCESS_MASK)) select |= CB710_DUMP_ACCESS_8; if (select & CB710_DUMP_ACCESS_32) cb710_read_and_dump_regs_32(chip, select); if (select & CB710_DUMP_ACCESS_16) cb710_read_and_dump_regs_16(chip, select); if (select & CB710_DUMP_ACCESS_8) cb710_read_and_dump_regs_8(chip, select); } EXPORT_SYMBOL_GPL(cb710_dump_regs);