drivers/misc/cb710/debug.c

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