1100966Siwasaki// SPDX-License-Identifier: GPL-2.0-only 2100966Siwasaki/* 3100966Siwasaki * cb710/debug.c 4100966Siwasaki * 5100966Siwasaki * Copyright by Micha�� Miros��aw, 2008-2009 6100966Siwasaki */ 7217365Sjkim#include <linux/cb710.h> 8245582Sjkim#include <linux/kernel.h> 9100966Siwasaki#include <linux/module.h> 10100966Siwasaki 11217365Sjkim#define CB710_REG_COUNT 0x80 12217365Sjkim 13217365Sjkimstatic const u16 allow[CB710_REG_COUNT/16] = { 14217365Sjkim 0xFFF0, 0xFFFF, 0xFFFF, 0xFFFF, 15217365Sjkim 0xFFF0, 0xFFFF, 0xFFFF, 0xFFFF, 16217365Sjkim}; 17217365Sjkimstatic const char *const prefix[ARRAY_SIZE(allow)] = { 18217365Sjkim "MMC", "MMC", "MMC", "MMC", 19217365Sjkim "MS?", "MS?", "SM?", "SM?" 20217365Sjkim}; 21217365Sjkim 22217365Sjkimstatic inline int allow_reg_read(unsigned block, unsigned offset, unsigned bits) 23217365Sjkim{ 24217365Sjkim unsigned mask = (1 << bits/8) - 1; 25100966Siwasaki offset *= bits/8; 26217365Sjkim return ((allow[block] >> offset) & mask) == mask; 27217365Sjkim} 28217365Sjkim 29100966Siwasaki#define CB710_READ_REGS_TEMPLATE(t) \ 30217365Sjkimstatic void cb710_read_regs_##t(void __iomem *iobase, \ 31217365Sjkim u##t *reg, unsigned select) \ 32217365Sjkim{ \ 33217365Sjkim unsigned i, j; \ 34217365Sjkim \ 35217365Sjkim for (i = 0; i < ARRAY_SIZE(allow); ++i, reg += 16/(t/8)) { \ 36217365Sjkim if (!(select & (1 << i))) \ 37217365Sjkim continue; \ 38217365Sjkim \ 39217365Sjkim for (j = 0; j < 0x10/(t/8); ++j) { \ 40217365Sjkim if (!allow_reg_read(i, j, t)) \ 41217365Sjkim continue; \ 42217365Sjkim reg[j] = ioread##t(iobase \ 43100966Siwasaki + (i << 4) + (j * (t/8))); \ 44100966Siwasaki } \ 45193341Sjkim } \ 46193341Sjkim} 47193341Sjkim 48193341Sjkimstatic const char cb710_regf_8[] = "%02X"; 49193341Sjkimstatic const char cb710_regf_16[] = "%04X"; 50193341Sjkimstatic const char cb710_regf_32[] = "%08X"; 51100966Siwasakistatic const char cb710_xes[] = "xxxxxxxx"; 52100966Siwasaki 53100966Siwasaki#define CB710_DUMP_REGS_TEMPLATE(t) \ 54100966Siwasakistatic void cb710_dump_regs_##t(struct device *dev, \ 55102550Siwasaki const u##t *reg, unsigned select) \ 56100966Siwasaki{ \ 57100966Siwasaki const char *const xp = &cb710_xes[8 - t/4]; \ 58100966Siwasaki const char *const format = cb710_regf_##t; \ 59151937Sjkim \ 60100966Siwasaki char msg[100], *p; \ 61198237Sjkim unsigned i, j; \ 62198237Sjkim \ 63198237Sjkim for (i = 0; i < ARRAY_SIZE(allow); ++i, reg += 16/(t/8)) { \ 64198237Sjkim if (!(select & (1 << i))) \ 65198237Sjkim continue; \ 66198237Sjkim p = msg; \ 67198237Sjkim for (j = 0; j < 0x10/(t/8); ++j) { \ 68198237Sjkim *p++ = ' '; \ 69198237Sjkim if (j == 8/(t/8)) \ 70198237Sjkim *p++ = ' '; \ 71198237Sjkim if (allow_reg_read(i, j, t)) \ 72151937Sjkim p += sprintf(p, format, reg[j]); \ 73100966Siwasaki else \ 74151937Sjkim p += sprintf(p, "%s", xp); \ 75151937Sjkim } \ 76151937Sjkim dev_dbg(dev, "%s 0x%02X %s\n", prefix[i], i << 4, msg); \ 77151937Sjkim } \ 78151937Sjkim} 79151937Sjkim 80151937Sjkim#define CB710_READ_AND_DUMP_REGS_TEMPLATE(t) \ 81151937Sjkimstatic void cb710_read_and_dump_regs_##t(struct cb710_chip *chip, \ 82151937Sjkim unsigned select) \ 83151937Sjkim{ \ 84151937Sjkim u##t regs[CB710_REG_COUNT/sizeof(u##t)]; \ 85151937Sjkim \ 86151937Sjkim memset(®s, 0, sizeof(regs)); \ 87151937Sjkim cb710_read_regs_##t(chip->iobase, regs, select); \ 88151937Sjkim cb710_dump_regs_##t(cb710_chip_dev(chip), regs, select); \ 89151937Sjkim} 90151937Sjkim 91100966Siwasaki#define CB710_REG_ACCESS_TEMPLATES(t) \ 92100966Siwasaki CB710_READ_REGS_TEMPLATE(t) \ 93100966Siwasaki CB710_DUMP_REGS_TEMPLATE(t) \ 94100966Siwasaki CB710_READ_AND_DUMP_REGS_TEMPLATE(t) 95151937Sjkim 96151937SjkimCB710_REG_ACCESS_TEMPLATES(8) 97100966SiwasakiCB710_REG_ACCESS_TEMPLATES(16) 98100966SiwasakiCB710_REG_ACCESS_TEMPLATES(32) 99100966Siwasaki 100100966Siwasakivoid cb710_dump_regs(struct cb710_chip *chip, unsigned select) 101241973Sjkim{ 102100966Siwasaki if (!(select & CB710_DUMP_REGS_MASK)) 103100966Siwasaki select = CB710_DUMP_REGS_ALL; 104100966Siwasaki if (!(select & CB710_DUMP_ACCESS_MASK)) 105100966Siwasaki select |= CB710_DUMP_ACCESS_8; 106100966Siwasaki 107100966Siwasaki if (select & CB710_DUMP_ACCESS_32) 108100966Siwasaki cb710_read_and_dump_regs_32(chip, select); 109100966Siwasaki if (select & CB710_DUMP_ACCESS_16) 110100966Siwasaki cb710_read_and_dump_regs_16(chip, select); 111100966Siwasaki if (select & CB710_DUMP_ACCESS_8) 112100966Siwasaki cb710_read_and_dump_regs_8(chip, select); 113100966Siwasaki} 114100966SiwasakiEXPORT_SYMBOL_GPL(cb710_dump_regs); 115100966Siwasaki 116100966Siwasaki