1/*
2 *  cb710/debug.c
3 *
4 *  Copyright by Michał Mirosław, 2008-2009
5 *
6 * This program is free software; you can redistribute it and/or modify
7 * it under the terms of the GNU General Public License version 2 as
8 * published by the Free Software Foundation.
9 */
10#include <linux/cb710.h>
11#include <linux/kernel.h>
12#include <linux/module.h>
13
14#define CB710_REG_COUNT		0x80
15
16static const u16 allow[CB710_REG_COUNT/16] = {
17	0xFFF0, 0xFFFF, 0xFFFF, 0xFFFF,
18	0xFFF0, 0xFFFF, 0xFFFF, 0xFFFF,
19};
20static const char *const prefix[ARRAY_SIZE(allow)] = {
21	"MMC", "MMC", "MMC", "MMC",
22	"MS?", "MS?", "SM?", "SM?"
23};
24
25static inline int allow_reg_read(unsigned block, unsigned offset, unsigned bits)
26{
27	unsigned mask = (1 << bits/8) - 1;
28	offset *= bits/8;
29	return ((allow[block] >> offset) & mask) == mask;
30}
31
32#define CB710_READ_REGS_TEMPLATE(t)					\
33static void cb710_read_regs_##t(void __iomem *iobase,			\
34	u##t *reg, unsigned select)					\
35{									\
36	unsigned i, j;							\
37									\
38	for (i = 0; i < ARRAY_SIZE(allow); ++i, reg += 16/(t/8)) {	\
39		if (!(select & (1 << i)))					\
40			continue;					\
41									\
42		for (j = 0; j < 0x10/(t/8); ++j) {			\
43			if (!allow_reg_read(i, j, t))			\
44				continue;				\
45			reg[j] = ioread##t(iobase			\
46				+ (i << 4) + (j * (t/8)));		\
47		}							\
48	}								\
49}
50
51static const char cb710_regf_8[] = "%02X";
52static const char cb710_regf_16[] = "%04X";
53static const char cb710_regf_32[] = "%08X";
54static const char cb710_xes[] = "xxxxxxxx";
55
56#define CB710_DUMP_REGS_TEMPLATE(t)					\
57static void cb710_dump_regs_##t(struct device *dev,			\
58	const u##t *reg, unsigned select)				\
59{									\
60	const char *const xp = &cb710_xes[8 - t/4];			\
61	const char *const format = cb710_regf_##t;			\
62									\
63	char msg[100], *p;						\
64	unsigned i, j;							\
65									\
66	for (i = 0; i < ARRAY_SIZE(allow); ++i, reg += 16/(t/8)) {	\
67		if (!(select & (1 << i)))				\
68			continue;					\
69		p = msg;						\
70		for (j = 0; j < 0x10/(t/8); ++j) {			\
71			*p++ = ' ';					\
72			if (j == 8/(t/8))				\
73				*p++ = ' ';				\
74			if (allow_reg_read(i, j, t))			\
75				p += sprintf(p, format, reg[j]);	\
76			else						\
77				p += sprintf(p, "%s", xp);		\
78		}							\
79		dev_dbg(dev, "%s 0x%02X %s\n", prefix[i], i << 4, msg);	\
80	}								\
81}
82
83#define CB710_READ_AND_DUMP_REGS_TEMPLATE(t)				\
84static void cb710_read_and_dump_regs_##t(struct cb710_chip *chip,	\
85	unsigned select)						\
86{									\
87	u##t regs[CB710_REG_COUNT/sizeof(u##t)];			\
88									\
89	memset(&regs, 0, sizeof(regs));					\
90	cb710_read_regs_##t(chip->iobase, regs, select);		\
91	cb710_dump_regs_##t(cb710_chip_dev(chip), regs, select);	\
92}
93
94#define CB710_REG_ACCESS_TEMPLATES(t)		\
95  CB710_READ_REGS_TEMPLATE(t)			\
96  CB710_DUMP_REGS_TEMPLATE(t)			\
97  CB710_READ_AND_DUMP_REGS_TEMPLATE(t)
98
99CB710_REG_ACCESS_TEMPLATES(8)
100CB710_REG_ACCESS_TEMPLATES(16)
101CB710_REG_ACCESS_TEMPLATES(32)
102
103void cb710_dump_regs(struct cb710_chip *chip, unsigned select)
104{
105	if (!(select & CB710_DUMP_REGS_MASK))
106		select = CB710_DUMP_REGS_ALL;
107	if (!(select & CB710_DUMP_ACCESS_MASK))
108		select |= CB710_DUMP_ACCESS_8;
109
110	if (select & CB710_DUMP_ACCESS_32)
111		cb710_read_and_dump_regs_32(chip, select);
112	if (select & CB710_DUMP_ACCESS_16)
113		cb710_read_and_dump_regs_16(chip, select);
114	if (select & CB710_DUMP_ACCESS_8)
115		cb710_read_and_dump_regs_8(chip, select);
116}
117EXPORT_SYMBOL_GPL(cb710_dump_regs);
118
119