disable pwm7

hc

2024-05-10 23fa18eaa71266feff7ba8d83022d9e1cc83c65a

1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
// 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(&regs, 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);