116 lines · c
1// SPDX-License-Identifier: GPL-2.0-only2/*3 * cb710/debug.c4 *5 * Copyright by Michał Mirosław, 2008-20096 */7#include <linux/cb710.h>8#include <linux/kernel.h>9#include <linux/module.h>10 11#define CB710_REG_COUNT 0x8012 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 116