]>
Commit | Line | Data |
---|---|---|
348f3cde BW |
1 | // SPDX-License-Identifier: GPL-2.0 |
2 | /* | |
3 | * Copyright (C) 2018 Spreadtrum Communications Inc. | |
4 | * Copyright (C) 2018 Linaro Ltd. | |
5 | */ | |
6 | ||
7 | #include <linux/gpio/driver.h> | |
8 | #include <linux/interrupt.h> | |
9 | #include <linux/kernel.h> | |
10 | #include <linux/module.h> | |
e91d0f05 | 11 | #include <linux/of.h> |
348f3cde BW |
12 | #include <linux/platform_device.h> |
13 | #include <linux/regmap.h> | |
14 | ||
15 | /* EIC registers definition */ | |
16 | #define SPRD_PMIC_EIC_DATA 0x0 | |
17 | #define SPRD_PMIC_EIC_DMSK 0x4 | |
18 | #define SPRD_PMIC_EIC_IEV 0x14 | |
19 | #define SPRD_PMIC_EIC_IE 0x18 | |
20 | #define SPRD_PMIC_EIC_RIS 0x1c | |
21 | #define SPRD_PMIC_EIC_MIS 0x20 | |
22 | #define SPRD_PMIC_EIC_IC 0x24 | |
23 | #define SPRD_PMIC_EIC_TRIG 0x28 | |
24 | #define SPRD_PMIC_EIC_CTRL0 0x40 | |
25 | ||
26 | /* | |
27 | * The PMIC EIC controller only has one bank, and each bank now can contain | |
28 | * 16 EICs. | |
29 | */ | |
30 | #define SPRD_PMIC_EIC_PER_BANK_NR 16 | |
31 | #define SPRD_PMIC_EIC_NR SPRD_PMIC_EIC_PER_BANK_NR | |
32 | #define SPRD_PMIC_EIC_DATA_MASK GENMASK(15, 0) | |
33 | #define SPRD_PMIC_EIC_BIT(x) ((x) & (SPRD_PMIC_EIC_PER_BANK_NR - 1)) | |
34 | #define SPRD_PMIC_EIC_DBNC_MASK GENMASK(11, 0) | |
35 | ||
36 | /* | |
37 | * These registers are modified under the irq bus lock and cached to avoid | |
38 | * unnecessary writes in bus_sync_unlock. | |
39 | */ | |
40 | enum { | |
41 | REG_IEV, | |
42 | REG_IE, | |
43 | REG_TRIG, | |
44 | CACHE_NR_REGS | |
45 | }; | |
46 | ||
47 | /** | |
48 | * struct sprd_pmic_eic - PMIC EIC controller | |
49 | * @chip: the gpio_chip structure. | |
3cd7f770 | 50 | * @map: the regmap from the parent device. |
348f3cde BW |
51 | * @offset: the EIC controller's offset address of the PMIC. |
52 | * @reg: the array to cache the EIC registers. | |
53 | * @buslock: for bus lock/sync and unlock. | |
54 | * @irq: the interrupt number of the PMIC EIC conteroller. | |
55 | */ | |
56 | struct sprd_pmic_eic { | |
57 | struct gpio_chip chip; | |
348f3cde BW |
58 | struct regmap *map; |
59 | u32 offset; | |
60 | u8 reg[CACHE_NR_REGS]; | |
61 | struct mutex buslock; | |
62 | int irq; | |
63 | }; | |
64 | ||
65 | static void sprd_pmic_eic_update(struct gpio_chip *chip, unsigned int offset, | |
66 | u16 reg, unsigned int val) | |
67 | { | |
68 | struct sprd_pmic_eic *pmic_eic = gpiochip_get_data(chip); | |
69 | u32 shift = SPRD_PMIC_EIC_BIT(offset); | |
70 | ||
71 | regmap_update_bits(pmic_eic->map, pmic_eic->offset + reg, | |
72 | BIT(shift), val << shift); | |
73 | } | |
74 | ||
75 | static int sprd_pmic_eic_read(struct gpio_chip *chip, unsigned int offset, | |
76 | u16 reg) | |
77 | { | |
78 | struct sprd_pmic_eic *pmic_eic = gpiochip_get_data(chip); | |
79 | u32 value; | |
80 | int ret; | |
81 | ||
82 | ret = regmap_read(pmic_eic->map, pmic_eic->offset + reg, &value); | |
83 | if (ret) | |
84 | return ret; | |
85 | ||
86 | return !!(value & BIT(SPRD_PMIC_EIC_BIT(offset))); | |
87 | } | |
88 | ||
89 | static int sprd_pmic_eic_request(struct gpio_chip *chip, unsigned int offset) | |
90 | { | |
91 | sprd_pmic_eic_update(chip, offset, SPRD_PMIC_EIC_DMSK, 1); | |
92 | return 0; | |
93 | } | |
94 | ||
95 | static void sprd_pmic_eic_free(struct gpio_chip *chip, unsigned int offset) | |
96 | { | |
97 | sprd_pmic_eic_update(chip, offset, SPRD_PMIC_EIC_DMSK, 0); | |
98 | } | |
99 | ||
100 | static int sprd_pmic_eic_get(struct gpio_chip *chip, unsigned int offset) | |
101 | { | |
102 | return sprd_pmic_eic_read(chip, offset, SPRD_PMIC_EIC_DATA); | |
103 | } | |
104 | ||
105 | static int sprd_pmic_eic_direction_input(struct gpio_chip *chip, | |
106 | unsigned int offset) | |
107 | { | |
108 | /* EICs are always input, nothing need to do here. */ | |
109 | return 0; | |
110 | } | |
111 | ||
112 | static void sprd_pmic_eic_set(struct gpio_chip *chip, unsigned int offset, | |
113 | int value) | |
114 | { | |
115 | /* EICs are always input, nothing need to do here. */ | |
116 | } | |
117 | ||
118 | static int sprd_pmic_eic_set_debounce(struct gpio_chip *chip, | |
119 | unsigned int offset, | |
120 | unsigned int debounce) | |
121 | { | |
122 | struct sprd_pmic_eic *pmic_eic = gpiochip_get_data(chip); | |
123 | u32 reg, value; | |
124 | int ret; | |
125 | ||
126 | reg = SPRD_PMIC_EIC_CTRL0 + SPRD_PMIC_EIC_BIT(offset) * 0x4; | |
127 | ret = regmap_read(pmic_eic->map, pmic_eic->offset + reg, &value); | |
128 | if (ret) | |
129 | return ret; | |
130 | ||
131 | value &= ~SPRD_PMIC_EIC_DBNC_MASK; | |
132 | value |= (debounce / 1000) & SPRD_PMIC_EIC_DBNC_MASK; | |
133 | return regmap_write(pmic_eic->map, pmic_eic->offset + reg, value); | |
134 | } | |
135 | ||
136 | static int sprd_pmic_eic_set_config(struct gpio_chip *chip, unsigned int offset, | |
137 | unsigned long config) | |
138 | { | |
139 | unsigned long param = pinconf_to_config_param(config); | |
140 | u32 arg = pinconf_to_config_argument(config); | |
141 | ||
142 | if (param == PIN_CONFIG_INPUT_DEBOUNCE) | |
143 | return sprd_pmic_eic_set_debounce(chip, offset, arg); | |
144 | ||
145 | return -ENOTSUPP; | |
146 | } | |
147 | ||
148 | static void sprd_pmic_eic_irq_mask(struct irq_data *data) | |
149 | { | |
150 | struct gpio_chip *chip = irq_data_get_irq_chip_data(data); | |
151 | struct sprd_pmic_eic *pmic_eic = gpiochip_get_data(chip); | |
be43eea7 | 152 | u32 offset = irqd_to_hwirq(data); |
348f3cde | 153 | |
0f57b213 WL |
154 | pmic_eic->reg[REG_IE] &= ~BIT(offset); |
155 | pmic_eic->reg[REG_TRIG] &= ~BIT(offset); | |
be43eea7 CG |
156 | |
157 | gpiochip_disable_irq(chip, offset); | |
348f3cde BW |
158 | } |
159 | ||
160 | static void sprd_pmic_eic_irq_unmask(struct irq_data *data) | |
161 | { | |
162 | struct gpio_chip *chip = irq_data_get_irq_chip_data(data); | |
163 | struct sprd_pmic_eic *pmic_eic = gpiochip_get_data(chip); | |
be43eea7 CG |
164 | u32 offset = irqd_to_hwirq(data); |
165 | ||
166 | gpiochip_enable_irq(chip, offset); | |
348f3cde | 167 | |
0f57b213 WL |
168 | pmic_eic->reg[REG_IE] |= BIT(offset); |
169 | pmic_eic->reg[REG_TRIG] |= BIT(offset); | |
348f3cde BW |
170 | } |
171 | ||
172 | static int sprd_pmic_eic_irq_set_type(struct irq_data *data, | |
173 | unsigned int flow_type) | |
174 | { | |
175 | struct gpio_chip *chip = irq_data_get_irq_chip_data(data); | |
176 | struct sprd_pmic_eic *pmic_eic = gpiochip_get_data(chip); | |
0f57b213 | 177 | u32 offset = irqd_to_hwirq(data); |
348f3cde BW |
178 | |
179 | switch (flow_type) { | |
180 | case IRQ_TYPE_LEVEL_HIGH: | |
0f57b213 | 181 | pmic_eic->reg[REG_IEV] |= BIT(offset); |
348f3cde BW |
182 | break; |
183 | case IRQ_TYPE_LEVEL_LOW: | |
0f57b213 | 184 | pmic_eic->reg[REG_IEV] &= ~BIT(offset); |
348f3cde | 185 | break; |
92da8b9d BW |
186 | case IRQ_TYPE_EDGE_RISING: |
187 | case IRQ_TYPE_EDGE_FALLING: | |
188 | case IRQ_TYPE_EDGE_BOTH: | |
189 | /* | |
190 | * Will set the trigger level according to current EIC level | |
191 | * in irq_bus_sync_unlock() interface, so here nothing to do. | |
192 | */ | |
193 | break; | |
348f3cde BW |
194 | default: |
195 | return -ENOTSUPP; | |
196 | } | |
197 | ||
198 | return 0; | |
199 | } | |
200 | ||
201 | static void sprd_pmic_eic_bus_lock(struct irq_data *data) | |
202 | { | |
203 | struct gpio_chip *chip = irq_data_get_irq_chip_data(data); | |
204 | struct sprd_pmic_eic *pmic_eic = gpiochip_get_data(chip); | |
205 | ||
206 | mutex_lock(&pmic_eic->buslock); | |
207 | } | |
208 | ||
209 | static void sprd_pmic_eic_bus_sync_unlock(struct irq_data *data) | |
210 | { | |
211 | struct gpio_chip *chip = irq_data_get_irq_chip_data(data); | |
212 | struct sprd_pmic_eic *pmic_eic = gpiochip_get_data(chip); | |
92da8b9d | 213 | u32 trigger = irqd_get_trigger_type(data); |
348f3cde | 214 | u32 offset = irqd_to_hwirq(data); |
92da8b9d | 215 | int state; |
348f3cde BW |
216 | |
217 | /* Set irq type */ | |
92da8b9d BW |
218 | if (trigger & IRQ_TYPE_EDGE_BOTH) { |
219 | state = sprd_pmic_eic_get(chip, offset); | |
220 | if (state) | |
221 | sprd_pmic_eic_update(chip, offset, SPRD_PMIC_EIC_IEV, 0); | |
222 | else | |
223 | sprd_pmic_eic_update(chip, offset, SPRD_PMIC_EIC_IEV, 1); | |
224 | } else { | |
225 | sprd_pmic_eic_update(chip, offset, SPRD_PMIC_EIC_IEV, | |
0f57b213 | 226 | !!(pmic_eic->reg[REG_IEV] & BIT(offset))); |
92da8b9d BW |
227 | } |
228 | ||
348f3cde BW |
229 | /* Set irq unmask */ |
230 | sprd_pmic_eic_update(chip, offset, SPRD_PMIC_EIC_IE, | |
0f57b213 | 231 | !!(pmic_eic->reg[REG_IE] & BIT(offset))); |
348f3cde BW |
232 | /* Generate trigger start pulse for debounce EIC */ |
233 | sprd_pmic_eic_update(chip, offset, SPRD_PMIC_EIC_TRIG, | |
0f57b213 | 234 | !!(pmic_eic->reg[REG_TRIG] & BIT(offset))); |
348f3cde BW |
235 | |
236 | mutex_unlock(&pmic_eic->buslock); | |
237 | } | |
238 | ||
92da8b9d BW |
239 | static void sprd_pmic_eic_toggle_trigger(struct gpio_chip *chip, |
240 | unsigned int irq, unsigned int offset) | |
241 | { | |
242 | u32 trigger = irq_get_trigger_type(irq); | |
243 | int state, post_state; | |
244 | ||
245 | if (!(trigger & IRQ_TYPE_EDGE_BOTH)) | |
246 | return; | |
247 | ||
248 | state = sprd_pmic_eic_get(chip, offset); | |
249 | retry: | |
250 | if (state) | |
251 | sprd_pmic_eic_update(chip, offset, SPRD_PMIC_EIC_IEV, 0); | |
252 | else | |
253 | sprd_pmic_eic_update(chip, offset, SPRD_PMIC_EIC_IEV, 1); | |
254 | ||
255 | post_state = sprd_pmic_eic_get(chip, offset); | |
256 | if (state != post_state) { | |
257 | dev_warn(chip->parent, "PMIC EIC level was changed.\n"); | |
258 | state = post_state; | |
259 | goto retry; | |
260 | } | |
261 | ||
262 | /* Set irq unmask */ | |
263 | sprd_pmic_eic_update(chip, offset, SPRD_PMIC_EIC_IE, 1); | |
264 | /* Generate trigger start pulse for debounce EIC */ | |
265 | sprd_pmic_eic_update(chip, offset, SPRD_PMIC_EIC_TRIG, 1); | |
266 | } | |
267 | ||
348f3cde BW |
268 | static irqreturn_t sprd_pmic_eic_irq_handler(int irq, void *data) |
269 | { | |
270 | struct sprd_pmic_eic *pmic_eic = data; | |
271 | struct gpio_chip *chip = &pmic_eic->chip; | |
272 | unsigned long status; | |
273 | u32 n, girq, val; | |
274 | int ret; | |
275 | ||
276 | ret = regmap_read(pmic_eic->map, pmic_eic->offset + SPRD_PMIC_EIC_MIS, | |
277 | &val); | |
278 | if (ret) | |
279 | return IRQ_RETVAL(ret); | |
280 | ||
281 | status = val & SPRD_PMIC_EIC_DATA_MASK; | |
282 | ||
283 | for_each_set_bit(n, &status, chip->ngpio) { | |
284 | /* Clear the interrupt */ | |
285 | sprd_pmic_eic_update(chip, n, SPRD_PMIC_EIC_IC, 1); | |
286 | ||
287 | girq = irq_find_mapping(chip->irq.domain, n); | |
288 | handle_nested_irq(girq); | |
92da8b9d BW |
289 | |
290 | /* | |
291 | * The PMIC EIC can only support level trigger, so we can | |
292 | * toggle the level trigger to emulate the edge trigger. | |
293 | */ | |
294 | sprd_pmic_eic_toggle_trigger(chip, girq, n); | |
348f3cde BW |
295 | } |
296 | ||
297 | return IRQ_HANDLED; | |
298 | } | |
299 | ||
be43eea7 CG |
300 | static const struct irq_chip pmic_eic_irq_chip = { |
301 | .name = "sprd-pmic-eic", | |
302 | .irq_mask = sprd_pmic_eic_irq_mask, | |
303 | .irq_unmask = sprd_pmic_eic_irq_unmask, | |
304 | .irq_set_type = sprd_pmic_eic_irq_set_type, | |
305 | .irq_bus_lock = sprd_pmic_eic_bus_lock, | |
306 | .irq_bus_sync_unlock = sprd_pmic_eic_bus_sync_unlock, | |
307 | .flags = IRQCHIP_SKIP_SET_WAKE | IRQCHIP_IMMUTABLE, | |
308 | GPIOCHIP_IRQ_RESOURCE_HELPERS, | |
309 | }; | |
310 | ||
348f3cde BW |
311 | static int sprd_pmic_eic_probe(struct platform_device *pdev) |
312 | { | |
313 | struct gpio_irq_chip *irq; | |
314 | struct sprd_pmic_eic *pmic_eic; | |
315 | int ret; | |
316 | ||
317 | pmic_eic = devm_kzalloc(&pdev->dev, sizeof(*pmic_eic), GFP_KERNEL); | |
318 | if (!pmic_eic) | |
319 | return -ENOMEM; | |
320 | ||
321 | mutex_init(&pmic_eic->buslock); | |
322 | ||
323 | pmic_eic->irq = platform_get_irq(pdev, 0); | |
15bddb7d | 324 | if (pmic_eic->irq < 0) |
348f3cde | 325 | return pmic_eic->irq; |
348f3cde BW |
326 | |
327 | pmic_eic->map = dev_get_regmap(pdev->dev.parent, NULL); | |
328 | if (!pmic_eic->map) | |
329 | return -ENODEV; | |
330 | ||
331 | ret = of_property_read_u32(pdev->dev.of_node, "reg", &pmic_eic->offset); | |
332 | if (ret) { | |
333 | dev_err(&pdev->dev, "Failed to get PMIC EIC base address.\n"); | |
334 | return ret; | |
335 | } | |
336 | ||
337 | ret = devm_request_threaded_irq(&pdev->dev, pmic_eic->irq, NULL, | |
338 | sprd_pmic_eic_irq_handler, | |
348f3cde BW |
339 | IRQF_ONESHOT | IRQF_NO_SUSPEND, |
340 | dev_name(&pdev->dev), pmic_eic); | |
341 | if (ret) { | |
342 | dev_err(&pdev->dev, "Failed to request PMIC EIC IRQ.\n"); | |
343 | return ret; | |
344 | } | |
345 | ||
346 | pmic_eic->chip.label = dev_name(&pdev->dev); | |
347 | pmic_eic->chip.ngpio = SPRD_PMIC_EIC_NR; | |
348 | pmic_eic->chip.base = -1; | |
349 | pmic_eic->chip.parent = &pdev->dev; | |
348f3cde BW |
350 | pmic_eic->chip.direction_input = sprd_pmic_eic_direction_input; |
351 | pmic_eic->chip.request = sprd_pmic_eic_request; | |
352 | pmic_eic->chip.free = sprd_pmic_eic_free; | |
353 | pmic_eic->chip.set_config = sprd_pmic_eic_set_config; | |
354 | pmic_eic->chip.set = sprd_pmic_eic_set; | |
355 | pmic_eic->chip.get = sprd_pmic_eic_get; | |
26d9e564 | 356 | pmic_eic->chip.can_sleep = true; |
348f3cde | 357 | |
348f3cde | 358 | irq = &pmic_eic->chip.irq; |
be43eea7 | 359 | gpio_irq_chip_set_chip(irq, &pmic_eic_irq_chip); |
348f3cde BW |
360 | irq->threaded = true; |
361 | ||
362 | ret = devm_gpiochip_add_data(&pdev->dev, &pmic_eic->chip, pmic_eic); | |
363 | if (ret < 0) { | |
364 | dev_err(&pdev->dev, "Could not register gpiochip %d.\n", ret); | |
365 | return ret; | |
366 | } | |
367 | ||
348f3cde BW |
368 | return 0; |
369 | } | |
370 | ||
371 | static const struct of_device_id sprd_pmic_eic_of_match[] = { | |
567cbf07 | 372 | { .compatible = "sprd,sc2731-eic", }, |
348f3cde BW |
373 | { /* end of list */ } |
374 | }; | |
375 | MODULE_DEVICE_TABLE(of, sprd_pmic_eic_of_match); | |
376 | ||
377 | static struct platform_driver sprd_pmic_eic_driver = { | |
378 | .probe = sprd_pmic_eic_probe, | |
379 | .driver = { | |
380 | .name = "sprd-pmic-eic", | |
381 | .of_match_table = sprd_pmic_eic_of_match, | |
382 | }, | |
383 | }; | |
384 | ||
385 | module_platform_driver(sprd_pmic_eic_driver); | |
386 | ||
387 | MODULE_DESCRIPTION("Spreadtrum PMIC EIC driver"); | |
388 | MODULE_LICENSE("GPL v2"); |