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
  14 #define CB710_REG_COUNT         0x80
  15
  16 static const u16 allow[CB710_REG_COUNT/16] = {
  17         0xFFF0, 0xFFFF, 0xFFFF, 0xFFFF,
  18         0xFFF0, 0xFFFF, 0xFFFF, 0xFFFF,
  19 };
  20 static const char *const prefix[ARRAY_SIZE(allow)] = {
  21         "MMC", "MMC", "MMC", "MMC",
  22         "MS?", "MS?", "SM?", "SM?"
  23 };
  24
  25 static 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)                                     \
  33 static 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
  51 static const char cb710_regf_8[] = "%02X";
  52 static const char cb710_regf_16[] = "%04X";
  53 static const char cb710_regf_32[] = "%08X";
  54 static const char cb710_xes[] = "xxxxxxxx";
  55
  56 #define CB710_DUMP_REGS_TEMPLATE(t)                                     \
  57 static 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)                            \
  84 static 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
  99 CB710_REG_ACCESS_TEMPLATES(8)
 100 CB710_REG_ACCESS_TEMPLATES(16)
 101 CB710_REG_ACCESS_TEMPLATES(32)
 102
 103 void 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 }
 117 EXPORT_SYMBOL_GPL(cb710_dump_regs);
 118