forked from Qortal/Brooklyn
You can not select more than 25 topics
Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
115 lines
3.1 KiB
115 lines
3.1 KiB
// 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); |
|
|
|
|