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
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165
166
167
168
169
170
171
172
173
174
175
176
177
178
179
180
181
182
183
184
185
186
187
188
189
190
191
192
193
194
195
196
197
198
199
200
201
202
203
204
205
206
207
208
209
210
211
212
213
214
215
216
217
218
219
220
221
222
223
224
225
226
227
228
229
230
231
232
233
234
|
From: =?UTF-8?q?Uwe=20Kleine-K=C3=B6nig?= <u.kleine-koenig@pengutronix.de>
Date: Thu, 7 Feb 2013 09:45:30 +0100
Subject: [PATCH] efm board controller driver
---
drivers/mfd/Kconfig | 5 ++
drivers/mfd/Makefile | 1 +
drivers/mfd/efm32board.c | 192 +++++++++++++++++++++++++++++++++++++++++++++++
3 files changed, 198 insertions(+)
create mode 100644 drivers/mfd/efm32board.c
diff --git a/drivers/mfd/Kconfig b/drivers/mfd/Kconfig
index aecd6dd..cf93bd6 100644
--- a/drivers/mfd/Kconfig
+++ b/drivers/mfd/Kconfig
@@ -1145,6 +1145,11 @@ config MFD_WM8994
core support for the WM8994, in order to use the actual
functionaltiy of the device other drivers must be enabled.
+config MFD_EFM32BOARD
+ tristate "efm32 board"
+ depends on ARM
+ select MFD_CORE
+
endmenu
endif
diff --git a/drivers/mfd/Makefile b/drivers/mfd/Makefile
index 3c90051..9a53e91 100644
--- a/drivers/mfd/Makefile
+++ b/drivers/mfd/Makefile
@@ -159,3 +159,4 @@ obj-$(CONFIG_MFD_LM3533) += lm3533-core.o lm3533-ctrlbank.o
obj-$(CONFIG_VEXPRESS_CONFIG) += vexpress-config.o vexpress-sysreg.o
obj-$(CONFIG_MFD_RETU) += retu-mfd.o
obj-$(CONFIG_MFD_AS3711) += as3711.o
+obj-$(CONFIG_MFD_EFM32BOARD) += efm32board.o
diff --git a/drivers/mfd/efm32board.c b/drivers/mfd/efm32board.c
new file mode 100644
index 0000000..ae35916
--- /dev/null
+++ b/drivers/mfd/efm32board.c
@@ -0,0 +1,192 @@
+#include <linux/platform_device.h>
+#include <linux/irq.h>
+#include <linux/interrupt.h>
+#include <linux/irqdomain.h>
+#include <linux/export.h>
+#include <linux/of_gpio.h>
+#include <asm/io.h>
+
+#define DRIVER_NAME "efm32board"
+
+#define MAGIC 0x04
+#define INTFLAG 0x40
+#define INTEN 0x42
+
+struct efm32board_ddata {
+ void __iomem *base;
+ unsigned int irq;
+ struct irq_chip chip;
+ struct irq_domain *domain;
+};
+
+static void efm32board_irq_ack(struct irq_data *data)
+{
+ struct efm32board_ddata *ddata = irq_get_chip_data(data->irq);
+ unsigned short val;
+
+ /* XXX: locking */
+ val = readw(ddata->base + INTFLAG);
+ val &= ~(1 << data->hwirq);
+ writew(val, ddata->base + INTFLAG);
+}
+
+static void efm32board_irq_mask(struct irq_data *data)
+{
+ struct efm32board_ddata *ddata = irq_get_chip_data(data->irq);
+ unsigned short val;
+
+ if (data->hwirq != 2) {
+ /* XXX: locking */
+ val = readw(ddata->base + INTEN);
+ val &= ~(1 << data->hwirq);
+ writew(val, ddata->base + INTEN);
+ }
+}
+
+static void efm32board_irq_unmask(struct irq_data *data)
+{
+ struct efm32board_ddata *ddata = irq_get_chip_data(data->irq);
+ unsigned short val;
+
+ /* XXX: locking */
+ val = readw(ddata->base + INTEN);
+ val |= 1 << data->hwirq;
+ writew(val, ddata->base + INTEN);
+}
+
+static irqreturn_t efm32board_handler(int irq, void *data)
+{
+ unsigned short val;
+ struct efm32board_ddata *ddata = data;
+ irqreturn_t ret = IRQ_NONE;
+
+ val = readw(ddata->base + INTFLAG);
+ /* ack BC irq */
+ writew(0, ddata->base + INTFLAG);
+
+ while (val) {
+ int line = __fls(val);
+
+ if (!generic_handle_irq(irq_create_mapping(ddata->domain, line)))
+ ret = IRQ_HANDLED;
+ val &= ~(1 << line);
+ }
+ return ret;
+}
+
+int efm32board_irqdomain_map(struct irq_domain *d, unsigned int virq,
+ irq_hw_number_t hw)
+{
+ struct efm32board_ddata *ddata = d->host_data;
+
+ irq_set_chip_data(virq, ddata);
+ irq_set_chip_and_handler(virq, &ddata->chip, handle_edge_irq);
+
+ set_irq_flags(virq, IRQF_VALID);
+
+ return 0;
+}
+
+const struct irq_domain_ops efm32board_irqdomain_ops = {
+ .map = efm32board_irqdomain_map,
+ .xlate = irq_domain_xlate_onecell,
+};
+
+static int efm32board_probe(struct platform_device *pdev)
+{
+ struct resource *res;
+ int irq, gpio, ret;
+ struct efm32board_ddata *ddata;
+ unsigned short val;
+
+ ddata = devm_kzalloc(&pdev->dev, sizeof(*ddata), GFP_KERNEL);
+ if (!ddata) {
+ dev_err(&pdev->dev, "cannot allocate driver data");
+ return -ENOMEM;
+ }
+
+ res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
+ if (!res) {
+ dev_err(&pdev->dev, "can't get device resources\n");
+ return -ENOENT;
+ }
+
+ gpio = of_get_named_gpio_flags(pdev->dev.of_node, "irq-gpios", 0, NULL);
+ if (gpio < 0) {
+ dev_err(&pdev->dev, "can't get irq gpio\n");
+ return gpio;
+ }
+
+ ret = gpio_request(gpio, DRIVER_NAME);
+ if (ret) {
+ dev_err(&pdev->dev, "cannot request irq gpio\n");
+ return ret;
+ }
+
+ ret = gpio_direction_input(gpio);
+ if (ret) {
+ dev_err(&pdev->dev, "cannot configure irq gpio as input\n");
+ return ret;
+ }
+
+ irq = gpio_to_irq(gpio);
+ if (irq <= 0) {
+ dev_err(&pdev->dev, "can't get irq number\n");
+ return irq < 0 ? irq : -ENOENT;
+ }
+ ddata->irq = irq;
+
+ ddata->base = devm_request_and_ioremap(&pdev->dev, res);
+ if (!ddata->base) {
+ dev_err(&pdev->dev, "cannot request and ioremap register set\n");
+ return -EADDRNOTAVAIL;
+ }
+
+ val = readw(ddata->base + MAGIC);
+ if (val != 0xef32) {
+ dev_err(&pdev->dev, "Magic not found (0x%hx)\n", val);
+ return -ENODEV;
+ }
+
+ /* disable and clear all irqs */
+ writew(0, ddata->base + INTEN);
+ writew(0, ddata->base + INTFLAG);
+
+ /* XXX: enable joystick irq */
+ writew(4, ddata->base + INTEN);
+
+ ddata->chip.name = DRIVER_NAME;
+ ddata->chip.irq_ack = efm32board_irq_ack;
+ ddata->chip.irq_mask = efm32board_irq_mask;
+ ddata->chip.irq_unmask = efm32board_irq_unmask;
+
+ ret = request_irq(irq, efm32board_handler, 0, DRIVER_NAME, ddata);
+ if (ret)
+ goto err_request_irq;
+
+ ddata->domain = irq_domain_add_simple(pdev->dev.of_node, 5, 0,
+ &efm32board_irqdomain_ops, ddata);
+ if (!ddata->domain) {
+ ret = -ENOMEM;
+ dev_err(&pdev->dev, "cannot create irq domain\n");
+
+ free_irq(irq, ddata);
+ }
+err_request_irq:
+ return ret;
+}
+
+static const struct of_device_id efm32board_dt_ids[] = {
+ { .compatible = "efm32board", },
+ { /* sentinel */ }
+};
+
+static struct platform_driver efm32board_driver = {
+ .probe = efm32board_probe,
+ .driver = {
+ .name = DRIVER_NAME,
+ .owner = THIS_MODULE,
+ .of_match_table = efm32board_dt_ids,
+ },
+};
+module_platform_driver(efm32board_driver);
|
