debug.c 3.1 KB

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