projects / linux-2.6-block.git / blame
? search:
summary | shortlog | log | commit | commitdiff | tree
blob | blame (incremental) | history | HEAD
pinctrl: Fix kernel-doc
[linux-2.6-block.git] / drivers / pinctrl / pinctrl-ocelot.c
CommitLineData
ce8dc094
AB		 1// SPDX-License-Identifier: (GPL-2.0 OR MIT)
2/*
3 * Microsemi SoCs pinctrl driver
4 *
5 * Author: <alexandre.belloni@free-electrons.com>
6 * License: Dual MIT/GPL
7 * Copyright (c) 2017 Microsemi Corporation
8 */
9
10#include <linux/gpio/driver.h>
11#include <linux/interrupt.h>
12#include <linux/io.h>
13#include <linux/of_device.h>
be36abb7 14#include <linux/of_irq.h>
ce8dc094
AB		 15#include <linux/of_platform.h>
16#include <linux/pinctrl/pinctrl.h>
17#include <linux/pinctrl/pinmux.h>
18#include <linux/pinctrl/pinconf.h>
19#include <linux/pinctrl/pinconf-generic.h>
20#include <linux/platform_device.h>
21#include <linux/regmap.h>
22#include <linux/slab.h>
23
24#include "core.h"
25#include "pinconf.h"
26#include "pinmux.h"
27
f8a74760
LP		 28#define ocelot_clrsetbits(addr, clear, set) \
29 writel((readl(addr) & ~(clear)) | (set), (addr))
30
31/* PINCONFIG bits (sparx5 only) */
32enum {
33 PINCONF_BIAS,
34 PINCONF_SCHMITT,
35 PINCONF_DRIVE_STRENGTH,
36};
37
38#define BIAS_PD_BIT BIT(4)
39#define BIAS_PU_BIT BIT(3)
40#define BIAS_BITS (BIAS_PD_BIT|BIAS_PU_BIT)
41#define SCHMITT_BIT BIT(2)
42#define DRIVE_BITS GENMASK(1, 0)
43
44/* GPIO standard registers */
ce8dc094
AB		 45#define OCELOT_GPIO_OUT_SET 0x0
46#define OCELOT_GPIO_OUT_CLR 0x4
47#define OCELOT_GPIO_OUT 0x8
48#define OCELOT_GPIO_IN 0xc
49#define OCELOT_GPIO_OE 0x10
50#define OCELOT_GPIO_INTR 0x14
51#define OCELOT_GPIO_INTR_ENA 0x18
52#define OCELOT_GPIO_INTR_IDENT 0x1c
53#define OCELOT_GPIO_ALT0 0x20
54#define OCELOT_GPIO_ALT1 0x24
55#define OCELOT_GPIO_SD_MAP 0x28
56
ce8dc094
AB		 57#define OCELOT_FUNC_PER_PIN 4
58
59enum {
60 FUNC_NONE,
61 FUNC_GPIO,
f8a74760 62 FUNC_IRQ0,
ce8dc094
AB		 63 FUNC_IRQ0_IN,
64 FUNC_IRQ0_OUT,
f8a74760 65 FUNC_IRQ1,
ce8dc094
AB		 66 FUNC_IRQ1_IN,
67 FUNC_IRQ1_OUT,
f8a74760 68 FUNC_EXT_IRQ,
edc72546 69 FUNC_MIIM,
f8a74760 70 FUNC_PHY_LED,
ce8dc094 71 FUNC_PCI_WAKE,
f8a74760 72 FUNC_MD,
ce8dc094
AB		 73 FUNC_PTP0,
74 FUNC_PTP1,
75 FUNC_PTP2,
76 FUNC_PTP3,
77 FUNC_PWM,
edc72546
LP		 78 FUNC_RECO_CLK,
79 FUNC_SFP,
ce8dc094 80 FUNC_SG0,
da801ab5
AB		 81 FUNC_SG1,
82 FUNC_SG2,
ce8dc094 83 FUNC_SI,
f8a74760 84 FUNC_SI2,
ce8dc094
AB		 85 FUNC_TACHO,
86 FUNC_TWI,
da801ab5 87 FUNC_TWI2,
f8a74760 88 FUNC_TWI3,
ce8dc094
AB		 89 FUNC_TWI_SCL_M,
90 FUNC_UART,
91 FUNC_UART2,
f8a74760
LP		 92 FUNC_UART3,
93 FUNC_PLL_STAT,
94 FUNC_EMMC,
95 FUNC_REF_CLK,
96 FUNC_RCVRD_CLK,
ce8dc094
AB		 97 FUNC_MAX
98};
99
100static const char *const ocelot_function_names[] = {
101 [FUNC_NONE] = "none",
102 [FUNC_GPIO] = "gpio",
f8a74760 103 [FUNC_IRQ0] = "irq0",
ce8dc094
AB		 104 [FUNC_IRQ0_IN] = "irq0_in",
105 [FUNC_IRQ0_OUT] = "irq0_out",
f8a74760 106 [FUNC_IRQ1] = "irq1",
ce8dc094
AB		 107 [FUNC_IRQ1_IN] = "irq1_in",
108 [FUNC_IRQ1_OUT] = "irq1_out",
f8a74760 109 [FUNC_EXT_IRQ] = "ext_irq",
edc72546 110 [FUNC_MIIM] = "miim",
f8a74760 111 [FUNC_PHY_LED] = "phy_led",
ce8dc094 112 [FUNC_PCI_WAKE] = "pci_wake",
f8a74760 113 [FUNC_MD] = "md",
ce8dc094
AB		 114 [FUNC_PTP0] = "ptp0",
115 [FUNC_PTP1] = "ptp1",
116 [FUNC_PTP2] = "ptp2",
117 [FUNC_PTP3] = "ptp3",
118 [FUNC_PWM] = "pwm",
edc72546
LP		 119 [FUNC_RECO_CLK] = "reco_clk",
120 [FUNC_SFP] = "sfp",
ce8dc094 121 [FUNC_SG0] = "sg0",
da801ab5
AB		 122 [FUNC_SG1] = "sg1",
123 [FUNC_SG2] = "sg2",
ce8dc094 124 [FUNC_SI] = "si",
f8a74760 125 [FUNC_SI2] = "si2",
ce8dc094
AB		 126 [FUNC_TACHO] = "tacho",
127 [FUNC_TWI] = "twi",
da801ab5 128 [FUNC_TWI2] = "twi2",
f8a74760 129 [FUNC_TWI3] = "twi3",
ce8dc094
AB		 130 [FUNC_TWI_SCL_M] = "twi_scl_m",
131 [FUNC_UART] = "uart",
132 [FUNC_UART2] = "uart2",
f8a74760
LP		 133 [FUNC_UART3] = "uart3",
134 [FUNC_PLL_STAT] = "pll_stat",
135 [FUNC_EMMC] = "emmc",
136 [FUNC_REF_CLK] = "ref_clk",
137 [FUNC_RCVRD_CLK] = "rcvrd_clk",
ce8dc094
AB		 138};
139
140struct ocelot_pmx_func {
141 const char **groups;
142 unsigned int ngroups;
143};
144
145struct ocelot_pin_caps {
146 unsigned int pin;
147 unsigned char functions[OCELOT_FUNC_PER_PIN];
148};
149
150struct ocelot_pinctrl {
151 struct device *dev;
152 struct pinctrl_dev *pctl;
153 struct gpio_chip gpio_chip;
154 struct regmap *map;
f8a74760 155 void __iomem *pincfg;
da801ab5 156 struct pinctrl_desc *desc;
ce8dc094 157 struct ocelot_pmx_func func[FUNC_MAX];
da801ab5 158 u8 stride;
ce8dc094
AB		 159};
160
8f27440d
LP		 161#define LUTON_P(p, f0, f1) \
162static struct ocelot_pin_caps luton_pin_##p = { \
163 .pin = p, \
164 .functions = { \
165 FUNC_GPIO, FUNC_##f0, FUNC_##f1, FUNC_NONE, \
166 }, \
167}
168
169LUTON_P(0, SG0, NONE);
170LUTON_P(1, SG0, NONE);
171LUTON_P(2, SG0, NONE);
172LUTON_P(3, SG0, NONE);
173LUTON_P(4, TACHO, NONE);
174LUTON_P(5, TWI, PHY_LED);
175LUTON_P(6, TWI, PHY_LED);
176LUTON_P(7, NONE, PHY_LED);
177LUTON_P(8, EXT_IRQ, PHY_LED);
178LUTON_P(9, EXT_IRQ, PHY_LED);
179LUTON_P(10, SFP, PHY_LED);
180LUTON_P(11, SFP, PHY_LED);
181LUTON_P(12, SFP, PHY_LED);
182LUTON_P(13, SFP, PHY_LED);
183LUTON_P(14, SI, PHY_LED);
184LUTON_P(15, SI, PHY_LED);
185LUTON_P(16, SI, PHY_LED);
186LUTON_P(17, SFP, PHY_LED);
187LUTON_P(18, SFP, PHY_LED);
188LUTON_P(19, SFP, PHY_LED);
189LUTON_P(20, SFP, PHY_LED);
190LUTON_P(21, SFP, PHY_LED);
191LUTON_P(22, SFP, PHY_LED);
192LUTON_P(23, SFP, PHY_LED);
193LUTON_P(24, SFP, PHY_LED);
194LUTON_P(25, SFP, PHY_LED);
195LUTON_P(26, SFP, PHY_LED);
196LUTON_P(27, SFP, PHY_LED);
197LUTON_P(28, SFP, PHY_LED);
198LUTON_P(29, PWM, NONE);
199LUTON_P(30, UART, NONE);
200LUTON_P(31, UART, NONE);
201
202#define LUTON_PIN(n) { \
203 .number = n, \
204 .name = "GPIO_"#n, \
205 .drv_data = &luton_pin_##n \
206}
207
208static const struct pinctrl_pin_desc luton_pins[] = {
209 LUTON_PIN(0),
210 LUTON_PIN(1),
211 LUTON_PIN(2),
212 LUTON_PIN(3),
213 LUTON_PIN(4),
214 LUTON_PIN(5),
215 LUTON_PIN(6),
216 LUTON_PIN(7),
217 LUTON_PIN(8),
218 LUTON_PIN(9),
219 LUTON_PIN(10),
220 LUTON_PIN(11),
221 LUTON_PIN(12),
222 LUTON_PIN(13),
223 LUTON_PIN(14),
224 LUTON_PIN(15),
225 LUTON_PIN(16),
226 LUTON_PIN(17),
227 LUTON_PIN(18),
228 LUTON_PIN(19),
229 LUTON_PIN(20),
230 LUTON_PIN(21),
231 LUTON_PIN(22),
232 LUTON_PIN(23),
233 LUTON_PIN(24),
234 LUTON_PIN(25),
235 LUTON_PIN(26),
236 LUTON_PIN(27),
237 LUTON_PIN(28),
238 LUTON_PIN(29),
239 LUTON_PIN(30),
240 LUTON_PIN(31),
241};
242
6e6347e2
LP		 243#define SERVAL_P(p, f0, f1, f2) \
244static struct ocelot_pin_caps serval_pin_##p = { \
245 .pin = p, \
246 .functions = { \
247 FUNC_GPIO, FUNC_##f0, FUNC_##f1, FUNC_##f2, \
248 }, \
249}
250
251SERVAL_P(0, SG0, NONE, NONE);
252SERVAL_P(1, SG0, NONE, NONE);
253SERVAL_P(2, SG0, NONE, NONE);
254SERVAL_P(3, SG0, NONE, NONE);
255SERVAL_P(4, TACHO, NONE, NONE);
256SERVAL_P(5, PWM, NONE, NONE);
257SERVAL_P(6, TWI, NONE, NONE);
258SERVAL_P(7, TWI, NONE, NONE);
259SERVAL_P(8, SI, NONE, NONE);
260SERVAL_P(9, SI, MD, NONE);
261SERVAL_P(10, SI, MD, NONE);
262SERVAL_P(11, SFP, MD, TWI_SCL_M);
263SERVAL_P(12, SFP, MD, TWI_SCL_M);
264SERVAL_P(13, SFP, UART2, TWI_SCL_M);
265SERVAL_P(14, SFP, UART2, TWI_SCL_M);
266SERVAL_P(15, SFP, PTP0, TWI_SCL_M);
267SERVAL_P(16, SFP, PTP0, TWI_SCL_M);
268SERVAL_P(17, SFP, PCI_WAKE, TWI_SCL_M);
269SERVAL_P(18, SFP, NONE, TWI_SCL_M);
270SERVAL_P(19, SFP, NONE, TWI_SCL_M);
271SERVAL_P(20, SFP, NONE, TWI_SCL_M);
272SERVAL_P(21, SFP, NONE, TWI_SCL_M);
273SERVAL_P(22, NONE, NONE, NONE);
274SERVAL_P(23, NONE, NONE, NONE);
275SERVAL_P(24, NONE, NONE, NONE);
276SERVAL_P(25, NONE, NONE, NONE);
277SERVAL_P(26, UART, NONE, NONE);
278SERVAL_P(27, UART, NONE, NONE);
279SERVAL_P(28, IRQ0, NONE, NONE);
280SERVAL_P(29, IRQ1, NONE, NONE);
281SERVAL_P(30, PTP0, NONE, NONE);
282SERVAL_P(31, PTP0, NONE, NONE);
283
284#define SERVAL_PIN(n) { \
285 .number = n, \
286 .name = "GPIO_"#n, \
287 .drv_data = &serval_pin_##n \
288}
289
290static const struct pinctrl_pin_desc serval_pins[] = {
291 SERVAL_PIN(0),
292 SERVAL_PIN(1),
293 SERVAL_PIN(2),
294 SERVAL_PIN(3),
295 SERVAL_PIN(4),
296 SERVAL_PIN(5),
297 SERVAL_PIN(6),
298 SERVAL_PIN(7),
299 SERVAL_PIN(8),
300 SERVAL_PIN(9),
301 SERVAL_PIN(10),
302 SERVAL_PIN(11),
303 SERVAL_PIN(12),
304 SERVAL_PIN(13),
305 SERVAL_PIN(14),
306 SERVAL_PIN(15),
307 SERVAL_PIN(16),
308 SERVAL_PIN(17),
309 SERVAL_PIN(18),
310 SERVAL_PIN(19),
311 SERVAL_PIN(20),
312 SERVAL_PIN(21),
313 SERVAL_PIN(22),
314 SERVAL_PIN(23),
315 SERVAL_PIN(24),
316 SERVAL_PIN(25),
317 SERVAL_PIN(26),
318 SERVAL_PIN(27),
319 SERVAL_PIN(28),
320 SERVAL_PIN(29),
321 SERVAL_PIN(30),
322 SERVAL_PIN(31),
323};
324
ce8dc094
AB		 325#define OCELOT_P(p, f0, f1, f2) \
326static struct ocelot_pin_caps ocelot_pin_##p = { \
327 .pin = p, \
328 .functions = { \
329 FUNC_GPIO, FUNC_##f0, FUNC_##f1, FUNC_##f2, \
330 }, \
331}
332
333OCELOT_P(0, SG0, NONE, NONE);
334OCELOT_P(1, SG0, NONE, NONE);
335OCELOT_P(2, SG0, NONE, NONE);
336OCELOT_P(3, SG0, NONE, NONE);
17f79084 337OCELOT_P(4, IRQ0_IN, IRQ0_OUT, TWI_SCL_M);
ce8dc094
AB		 338OCELOT_P(5, IRQ1_IN, IRQ1_OUT, PCI_WAKE);
339OCELOT_P(6, UART, TWI_SCL_M, NONE);
340OCELOT_P(7, UART, TWI_SCL_M, NONE);
341OCELOT_P(8, SI, TWI_SCL_M, IRQ0_OUT);
342OCELOT_P(9, SI, TWI_SCL_M, IRQ1_OUT);
edc72546
LP		 343OCELOT_P(10, PTP2, TWI_SCL_M, SFP);
344OCELOT_P(11, PTP3, TWI_SCL_M, SFP);
345OCELOT_P(12, UART2, TWI_SCL_M, SFP);
346OCELOT_P(13, UART2, TWI_SCL_M, SFP);
347OCELOT_P(14, MIIM, TWI_SCL_M, SFP);
348OCELOT_P(15, MIIM, TWI_SCL_M, SFP);
ce8dc094
AB		 349OCELOT_P(16, TWI, NONE, SI);
350OCELOT_P(17, TWI, TWI_SCL_M, SI);
351OCELOT_P(18, PTP0, TWI_SCL_M, NONE);
352OCELOT_P(19, PTP1, TWI_SCL_M, NONE);
edc72546
LP		 353OCELOT_P(20, RECO_CLK, TACHO, TWI_SCL_M);
354OCELOT_P(21, RECO_CLK, PWM, TWI_SCL_M);
ce8dc094
AB		 355
356#define OCELOT_PIN(n) { \
357 .number = n, \
358 .name = "GPIO_"#n, \
359 .drv_data = &ocelot_pin_##n \
360}
361
362static const struct pinctrl_pin_desc ocelot_pins[] = {
363 OCELOT_PIN(0),
364 OCELOT_PIN(1),
365 OCELOT_PIN(2),
366 OCELOT_PIN(3),
367 OCELOT_PIN(4),
368 OCELOT_PIN(5),
369 OCELOT_PIN(6),
370 OCELOT_PIN(7),
371 OCELOT_PIN(8),
372 OCELOT_PIN(9),
373 OCELOT_PIN(10),
374 OCELOT_PIN(11),
375 OCELOT_PIN(12),
376 OCELOT_PIN(13),
377 OCELOT_PIN(14),
378 OCELOT_PIN(15),
379 OCELOT_PIN(16),
380 OCELOT_PIN(17),
381 OCELOT_PIN(18),
382 OCELOT_PIN(19),
383 OCELOT_PIN(20),
384 OCELOT_PIN(21),
385};
386
da801ab5
AB		 387#define JAGUAR2_P(p, f0, f1) \
388static struct ocelot_pin_caps jaguar2_pin_##p = { \
389 .pin = p, \
390 .functions = { \
391 FUNC_GPIO, FUNC_##f0, FUNC_##f1, FUNC_NONE \
392 }, \
393}
394
395JAGUAR2_P(0, SG0, NONE);
396JAGUAR2_P(1, SG0, NONE);
397JAGUAR2_P(2, SG0, NONE);
398JAGUAR2_P(3, SG0, NONE);
399JAGUAR2_P(4, SG1, NONE);
400JAGUAR2_P(5, SG1, NONE);
401JAGUAR2_P(6, IRQ0_IN, IRQ0_OUT);
402JAGUAR2_P(7, IRQ1_IN, IRQ1_OUT);
403JAGUAR2_P(8, PTP0, NONE);
404JAGUAR2_P(9, PTP1, NONE);
405JAGUAR2_P(10, UART, NONE);
406JAGUAR2_P(11, UART, NONE);
407JAGUAR2_P(12, SG1, NONE);
408JAGUAR2_P(13, SG1, NONE);
409JAGUAR2_P(14, TWI, TWI_SCL_M);
410JAGUAR2_P(15, TWI, NONE);
411JAGUAR2_P(16, SI, TWI_SCL_M);
412JAGUAR2_P(17, SI, TWI_SCL_M);
413JAGUAR2_P(18, SI, TWI_SCL_M);
414JAGUAR2_P(19, PCI_WAKE, NONE);
415JAGUAR2_P(20, IRQ0_OUT, TWI_SCL_M);
416JAGUAR2_P(21, IRQ1_OUT, TWI_SCL_M);
417JAGUAR2_P(22, TACHO, NONE);
418JAGUAR2_P(23, PWM, NONE);
419JAGUAR2_P(24, UART2, NONE);
420JAGUAR2_P(25, UART2, SI);
421JAGUAR2_P(26, PTP2, SI);
422JAGUAR2_P(27, PTP3, SI);
423JAGUAR2_P(28, TWI2, SI);
424JAGUAR2_P(29, TWI2, SI);
425JAGUAR2_P(30, SG2, SI);
426JAGUAR2_P(31, SG2, SI);
427JAGUAR2_P(32, SG2, SI);
428JAGUAR2_P(33, SG2, SI);
429JAGUAR2_P(34, NONE, TWI_SCL_M);
430JAGUAR2_P(35, NONE, TWI_SCL_M);
431JAGUAR2_P(36, NONE, TWI_SCL_M);
432JAGUAR2_P(37, NONE, TWI_SCL_M);
433JAGUAR2_P(38, NONE, TWI_SCL_M);
434JAGUAR2_P(39, NONE, TWI_SCL_M);
435JAGUAR2_P(40, NONE, TWI_SCL_M);
436JAGUAR2_P(41, NONE, TWI_SCL_M);
437JAGUAR2_P(42, NONE, TWI_SCL_M);
438JAGUAR2_P(43, NONE, TWI_SCL_M);
edc72546
LP		 439JAGUAR2_P(44, NONE, SFP);
440JAGUAR2_P(45, NONE, SFP);
441JAGUAR2_P(46, NONE, SFP);
442JAGUAR2_P(47, NONE, SFP);
443JAGUAR2_P(48, SFP, NONE);
444JAGUAR2_P(49, SFP, SI);
445JAGUAR2_P(50, SFP, SI);
446JAGUAR2_P(51, SFP, SI);
447JAGUAR2_P(52, SFP, NONE);
448JAGUAR2_P(53, SFP, NONE);
449JAGUAR2_P(54, SFP, NONE);
450JAGUAR2_P(55, SFP, NONE);
451JAGUAR2_P(56, MIIM, SFP);
452JAGUAR2_P(57, MIIM, SFP);
453JAGUAR2_P(58, MIIM, SFP);
454JAGUAR2_P(59, MIIM, SFP);
da801ab5
AB		 455JAGUAR2_P(60, NONE, NONE);
456JAGUAR2_P(61, NONE, NONE);
457JAGUAR2_P(62, NONE, NONE);
458JAGUAR2_P(63, NONE, NONE);
459
460#define JAGUAR2_PIN(n) { \
461 .number = n, \
462 .name = "GPIO_"#n, \
463 .drv_data = &jaguar2_pin_##n \
464}
465
466static const struct pinctrl_pin_desc jaguar2_pins[] = {
467 JAGUAR2_PIN(0),
468 JAGUAR2_PIN(1),
469 JAGUAR2_PIN(2),
470 JAGUAR2_PIN(3),
471 JAGUAR2_PIN(4),
472 JAGUAR2_PIN(5),
473 JAGUAR2_PIN(6),
474 JAGUAR2_PIN(7),
475 JAGUAR2_PIN(8),
476 JAGUAR2_PIN(9),
477 JAGUAR2_PIN(10),
478 JAGUAR2_PIN(11),
479 JAGUAR2_PIN(12),
480 JAGUAR2_PIN(13),
481 JAGUAR2_PIN(14),
482 JAGUAR2_PIN(15),
483 JAGUAR2_PIN(16),
484 JAGUAR2_PIN(17),
485 JAGUAR2_PIN(18),
486 JAGUAR2_PIN(19),
487 JAGUAR2_PIN(20),
488 JAGUAR2_PIN(21),
489 JAGUAR2_PIN(22),
490 JAGUAR2_PIN(23),
491 JAGUAR2_PIN(24),
492 JAGUAR2_PIN(25),
493 JAGUAR2_PIN(26),
494 JAGUAR2_PIN(27),
495 JAGUAR2_PIN(28),
496 JAGUAR2_PIN(29),
497 JAGUAR2_PIN(30),
498 JAGUAR2_PIN(31),
499 JAGUAR2_PIN(32),
500 JAGUAR2_PIN(33),
501 JAGUAR2_PIN(34),
502 JAGUAR2_PIN(35),
503 JAGUAR2_PIN(36),
504 JAGUAR2_PIN(37),
505 JAGUAR2_PIN(38),
506 JAGUAR2_PIN(39),
507 JAGUAR2_PIN(40),
508 JAGUAR2_PIN(41),
509 JAGUAR2_PIN(42),
510 JAGUAR2_PIN(43),
511 JAGUAR2_PIN(44),
512 JAGUAR2_PIN(45),
513 JAGUAR2_PIN(46),
514 JAGUAR2_PIN(47),
515 JAGUAR2_PIN(48),
516 JAGUAR2_PIN(49),
517 JAGUAR2_PIN(50),
518 JAGUAR2_PIN(51),
519 JAGUAR2_PIN(52),
520 JAGUAR2_PIN(53),
521 JAGUAR2_PIN(54),
522 JAGUAR2_PIN(55),
523 JAGUAR2_PIN(56),
524 JAGUAR2_PIN(57),
525 JAGUAR2_PIN(58),
526 JAGUAR2_PIN(59),
527 JAGUAR2_PIN(60),
528 JAGUAR2_PIN(61),
529 JAGUAR2_PIN(62),
530 JAGUAR2_PIN(63),
531};
532
f8a74760
LP		 533#define SPARX5_P(p, f0, f1, f2) \
534static struct ocelot_pin_caps sparx5_pin_##p = { \
535 .pin = p, \
536 .functions = { \
537 FUNC_GPIO, FUNC_##f0, FUNC_##f1, FUNC_##f2 \
538 }, \
539}
540
541SPARX5_P(0, SG0, PLL_STAT, NONE);
542SPARX5_P(1, SG0, NONE, NONE);
543SPARX5_P(2, SG0, NONE, NONE);
544SPARX5_P(3, SG0, NONE, NONE);
545SPARX5_P(4, SG1, NONE, NONE);
546SPARX5_P(5, SG1, NONE, NONE);
547SPARX5_P(6, IRQ0_IN, IRQ0_OUT, SFP);
548SPARX5_P(7, IRQ1_IN, IRQ1_OUT, SFP);
549SPARX5_P(8, PTP0, NONE, SFP);
550SPARX5_P(9, PTP1, SFP, TWI_SCL_M);
551SPARX5_P(10, UART, NONE, NONE);
552SPARX5_P(11, UART, NONE, NONE);
553SPARX5_P(12, SG1, NONE, NONE);
554SPARX5_P(13, SG1, NONE, NONE);
555SPARX5_P(14, TWI, TWI_SCL_M, NONE);
556SPARX5_P(15, TWI, NONE, NONE);
557SPARX5_P(16, SI, TWI_SCL_M, SFP);
558SPARX5_P(17, SI, TWI_SCL_M, SFP);
559SPARX5_P(18, SI, TWI_SCL_M, SFP);
560SPARX5_P(19, PCI_WAKE, TWI_SCL_M, SFP);
561SPARX5_P(20, IRQ0_OUT, TWI_SCL_M, SFP);
562SPARX5_P(21, IRQ1_OUT, TACHO, SFP);
563SPARX5_P(22, TACHO, IRQ0_OUT, TWI_SCL_M);
564SPARX5_P(23, PWM, UART3, TWI_SCL_M);
565SPARX5_P(24, PTP2, UART3, TWI_SCL_M);
566SPARX5_P(25, PTP3, SI, TWI_SCL_M);
567SPARX5_P(26, UART2, SI, TWI_SCL_M);
568SPARX5_P(27, UART2, SI, TWI_SCL_M);
569SPARX5_P(28, TWI2, SI, SFP);
570SPARX5_P(29, TWI2, SI, SFP);
571SPARX5_P(30, SG2, SI, PWM);
572SPARX5_P(31, SG2, SI, TWI_SCL_M);
573SPARX5_P(32, SG2, SI, TWI_SCL_M);
574SPARX5_P(33, SG2, SI, SFP);
575SPARX5_P(34, NONE, TWI_SCL_M, EMMC);
576SPARX5_P(35, SFP, TWI_SCL_M, EMMC);
577SPARX5_P(36, SFP, TWI_SCL_M, EMMC);
578SPARX5_P(37, SFP, NONE, EMMC);
579SPARX5_P(38, NONE, TWI_SCL_M, EMMC);
580SPARX5_P(39, SI2, TWI_SCL_M, EMMC);
581SPARX5_P(40, SI2, TWI_SCL_M, EMMC);
582SPARX5_P(41, SI2, TWI_SCL_M, EMMC);
583SPARX5_P(42, SI2, TWI_SCL_M, EMMC);
584SPARX5_P(43, SI2, TWI_SCL_M, EMMC);
585SPARX5_P(44, SI, SFP, EMMC);
586SPARX5_P(45, SI, SFP, EMMC);
587SPARX5_P(46, NONE, SFP, EMMC);
588SPARX5_P(47, NONE, SFP, EMMC);
589SPARX5_P(48, TWI3, SI, SFP);
590SPARX5_P(49, TWI3, NONE, SFP);
591SPARX5_P(50, SFP, NONE, TWI_SCL_M);
592SPARX5_P(51, SFP, SI, TWI_SCL_M);
593SPARX5_P(52, SFP, MIIM, TWI_SCL_M);
594SPARX5_P(53, SFP, MIIM, TWI_SCL_M);
595SPARX5_P(54, SFP, PTP2, TWI_SCL_M);
596SPARX5_P(55, SFP, PTP3, PCI_WAKE);
597SPARX5_P(56, MIIM, SFP, TWI_SCL_M);
598SPARX5_P(57, MIIM, SFP, TWI_SCL_M);
599SPARX5_P(58, MIIM, SFP, TWI_SCL_M);
600SPARX5_P(59, MIIM, SFP, NONE);
601SPARX5_P(60, RECO_CLK, NONE, NONE);
602SPARX5_P(61, RECO_CLK, NONE, NONE);
603SPARX5_P(62, RECO_CLK, PLL_STAT, NONE);
604SPARX5_P(63, RECO_CLK, NONE, NONE);
605
606#define SPARX5_PIN(n) { \
607 .number = n, \
608 .name = "GPIO_"#n, \
609 .drv_data = &sparx5_pin_##n \
610}
611
612static const struct pinctrl_pin_desc sparx5_pins[] = {
613 SPARX5_PIN(0),
614 SPARX5_PIN(1),
615 SPARX5_PIN(2),
616 SPARX5_PIN(3),
617 SPARX5_PIN(4),
618 SPARX5_PIN(5),
619 SPARX5_PIN(6),
620 SPARX5_PIN(7),
621 SPARX5_PIN(8),
622 SPARX5_PIN(9),
623 SPARX5_PIN(10),
624 SPARX5_PIN(11),
625 SPARX5_PIN(12),
626 SPARX5_PIN(13),
627 SPARX5_PIN(14),
628 SPARX5_PIN(15),
629 SPARX5_PIN(16),
630 SPARX5_PIN(17),
631 SPARX5_PIN(18),
632 SPARX5_PIN(19),
633 SPARX5_PIN(20),
634 SPARX5_PIN(21),
635 SPARX5_PIN(22),
636 SPARX5_PIN(23),
637 SPARX5_PIN(24),
638 SPARX5_PIN(25),
639 SPARX5_PIN(26),
640 SPARX5_PIN(27),
641 SPARX5_PIN(28),
642 SPARX5_PIN(29),
643 SPARX5_PIN(30),
644 SPARX5_PIN(31),
645 SPARX5_PIN(32),
646 SPARX5_PIN(33),
647 SPARX5_PIN(34),
648 SPARX5_PIN(35),
649 SPARX5_PIN(36),
650 SPARX5_PIN(37),
651 SPARX5_PIN(38),
652 SPARX5_PIN(39),
653 SPARX5_PIN(40),
654 SPARX5_PIN(41),
655 SPARX5_PIN(42),
656 SPARX5_PIN(43),
657 SPARX5_PIN(44),
658 SPARX5_PIN(45),
659 SPARX5_PIN(46),
660 SPARX5_PIN(47),
661 SPARX5_PIN(48),
662 SPARX5_PIN(49),
663 SPARX5_PIN(50),
664 SPARX5_PIN(51),
665 SPARX5_PIN(52),
666 SPARX5_PIN(53),
667 SPARX5_PIN(54),
668 SPARX5_PIN(55),
669 SPARX5_PIN(56),
670 SPARX5_PIN(57),
671 SPARX5_PIN(58),
672 SPARX5_PIN(59),
673 SPARX5_PIN(60),
674 SPARX5_PIN(61),
675 SPARX5_PIN(62),
676 SPARX5_PIN(63),
677};
678
ce8dc094
AB		 679static int ocelot_get_functions_count(struct pinctrl_dev *pctldev)
680{
681 return ARRAY_SIZE(ocelot_function_names);
682}
683
684static const char *ocelot_get_function_name(struct pinctrl_dev *pctldev,
685 unsigned int function)
686{
687 return ocelot_function_names[function];
688}
689
690static int ocelot_get_function_groups(struct pinctrl_dev *pctldev,
691 unsigned int function,
692 const char *const **groups,
693 unsigned *const num_groups)
694{
695 struct ocelot_pinctrl *info = pinctrl_dev_get_drvdata(pctldev);
696
697 *groups = info->func[function].groups;
698 *num_groups = info->func[function].ngroups;
699
700 return 0;
701}
702
da801ab5
AB		 703static int ocelot_pin_function_idx(struct ocelot_pinctrl *info,
704 unsigned int pin, unsigned int function)
ce8dc094 705{
da801ab5 706 struct ocelot_pin_caps *p = info->desc->pins[pin].drv_data;
ce8dc094
AB		 707 int i;
708
709 for (i = 0; i < OCELOT_FUNC_PER_PIN; i++) {
710 if (function == p->functions[i])
711 return i;
712 }
713
714 return -1;
715}
716
4b36082e 717#define REG_ALT(msb, info, p) (OCELOT_GPIO_ALT0 * (info)->stride + 4 * ((msb) + ((info)->stride * ((p) / 32))))
da801ab5 718
ce8dc094
AB		 719static int ocelot_pinmux_set_mux(struct pinctrl_dev *pctldev,
720 unsigned int selector, unsigned int group)
721{
722 struct ocelot_pinctrl *info = pinctrl_dev_get_drvdata(pctldev);
da801ab5
AB		 723 struct ocelot_pin_caps *pin = info->desc->pins[group].drv_data;
724 unsigned int p = pin->pin % 32;
ce8dc094
AB		 725 int f;
726
da801ab5 727 f = ocelot_pin_function_idx(info, group, selector);
ce8dc094
AB		 728 if (f < 0)
729 return -EINVAL;
730
731 /*
732 * f is encoded on two bits.
4b36082e
AB		 733 * bit 0 of f goes in BIT(pin) of ALT[0], bit 1 of f goes in BIT(pin) of
734 * ALT[1]
ce8dc094
AB		 735 * This is racy because both registers can't be updated at the same time
736 * but it doesn't matter much for now.
f8a74760 737 * Note: ALT0/ALT1 are organized specially for 64 gpio targets
ce8dc094 738 */
4b36082e 739 regmap_update_bits(info->map, REG_ALT(0, info, pin->pin),
da801ab5 740 BIT(p), f << p);
4b36082e 741 regmap_update_bits(info->map, REG_ALT(1, info, pin->pin),
da801ab5 742 BIT(p), f << (p - 1));
ce8dc094
AB		 743
744 return 0;
745}
746
4b36082e
AB		 747#define REG(r, info, p) ((r) * (info)->stride + (4 * ((p) / 32)))
748
ce8dc094
AB		 749static int ocelot_gpio_set_direction(struct pinctrl_dev *pctldev,
750 struct pinctrl_gpio_range *range,
751 unsigned int pin, bool input)
752{
753 struct ocelot_pinctrl *info = pinctrl_dev_get_drvdata(pctldev);
da801ab5 754 unsigned int p = pin % 32;
ce8dc094 755
f2818ba3 756 regmap_update_bits(info->map, REG(OCELOT_GPIO_OE, info, pin), BIT(p),
da801ab5 757 input ? 0 : BIT(p));
ce8dc094
AB		 758
759 return 0;
760}
761
762static int ocelot_gpio_request_enable(struct pinctrl_dev *pctldev,
763 struct pinctrl_gpio_range *range,
764 unsigned int offset)
765{
766 struct ocelot_pinctrl *info = pinctrl_dev_get_drvdata(pctldev);
da801ab5 767 unsigned int p = offset % 32;
ce8dc094 768
4b36082e 769 regmap_update_bits(info->map, REG_ALT(0, info, offset),
da801ab5 770 BIT(p), 0);
4b36082e 771 regmap_update_bits(info->map, REG_ALT(1, info, offset),
da801ab5 772 BIT(p), 0);
ce8dc094
AB		 773
774 return 0;
775}
776
777static const struct pinmux_ops ocelot_pmx_ops = {
778 .get_functions_count = ocelot_get_functions_count,
779 .get_function_name = ocelot_get_function_name,
780 .get_function_groups = ocelot_get_function_groups,
781 .set_mux = ocelot_pinmux_set_mux,
782 .gpio_set_direction = ocelot_gpio_set_direction,
783 .gpio_request_enable = ocelot_gpio_request_enable,
784};
785
786static int ocelot_pctl_get_groups_count(struct pinctrl_dev *pctldev)
787{
da801ab5
AB		 788 struct ocelot_pinctrl *info = pinctrl_dev_get_drvdata(pctldev);
789
790 return info->desc->npins;
ce8dc094
AB		 791}
792
793static const char *ocelot_pctl_get_group_name(struct pinctrl_dev *pctldev,
794 unsigned int group)
795{
da801ab5
AB		 796 struct ocelot_pinctrl *info = pinctrl_dev_get_drvdata(pctldev);
797
798 return info->desc->pins[group].name;
ce8dc094
AB		 799}
800
801static int ocelot_pctl_get_group_pins(struct pinctrl_dev *pctldev,
802 unsigned int group,
803 const unsigned int **pins,
804 unsigned int *num_pins)
805{
da801ab5
AB		 806 struct ocelot_pinctrl *info = pinctrl_dev_get_drvdata(pctldev);
807
808 *pins = &info->desc->pins[group].number;
ce8dc094
AB		 809 *num_pins = 1;
810
811 return 0;
812}
813
f8a74760
LP		 814static int ocelot_hw_get_value(struct ocelot_pinctrl *info,
815 unsigned int pin,
816 unsigned int reg,
817 int *val)
818{
819 int ret = -EOPNOTSUPP;
820
821 if (info->pincfg) {
822 u32 regcfg = readl(info->pincfg + (pin * sizeof(u32)));
823
824 ret = 0;
825 switch (reg) {
826 case PINCONF_BIAS:
827 *val = regcfg & BIAS_BITS;
828 break;
829
830 case PINCONF_SCHMITT:
831 *val = regcfg & SCHMITT_BIT;
832 break;
833
834 case PINCONF_DRIVE_STRENGTH:
835 *val = regcfg & DRIVE_BITS;
836 break;
837
838 default:
839 ret = -EOPNOTSUPP;
840 break;
841 }
842 }
843 return ret;
844}
845
846static int ocelot_hw_set_value(struct ocelot_pinctrl *info,
847 unsigned int pin,
848 unsigned int reg,
849 int val)
850{
851 int ret = -EOPNOTSUPP;
852
853 if (info->pincfg) {
854 void __iomem *regaddr = info->pincfg + (pin * sizeof(u32));
855
856 ret = 0;
857 switch (reg) {
858 case PINCONF_BIAS:
859 ocelot_clrsetbits(regaddr, BIAS_BITS, val);
860 break;
861
862 case PINCONF_SCHMITT:
863 ocelot_clrsetbits(regaddr, SCHMITT_BIT, val);
864 break;
865
866 case PINCONF_DRIVE_STRENGTH:
867 if (val <= 3)
868 ocelot_clrsetbits(regaddr, DRIVE_BITS, val);
869 else
870 ret = -EINVAL;
871 break;
872
873 default:
874 ret = -EOPNOTSUPP;
875 break;
876 }
877 }
878 return ret;
879}
880
881static int ocelot_pinconf_get(struct pinctrl_dev *pctldev,
882 unsigned int pin, unsigned long *config)
883{
884 struct ocelot_pinctrl *info = pinctrl_dev_get_drvdata(pctldev);
885 u32 param = pinconf_to_config_param(*config);
886 int val, err;
887
888 switch (param) {
889 case PIN_CONFIG_BIAS_DISABLE:
890 case PIN_CONFIG_BIAS_PULL_UP:
891 case PIN_CONFIG_BIAS_PULL_DOWN:
892 err = ocelot_hw_get_value(info, pin, PINCONF_BIAS, &val);
893 if (err)
894 return err;
895 if (param == PIN_CONFIG_BIAS_DISABLE)
54515257 896 val = (val == 0);
f8a74760
LP		 897 else if (param == PIN_CONFIG_BIAS_PULL_DOWN)
898 val = (val & BIAS_PD_BIT ? true : false);
899 else /* PIN_CONFIG_BIAS_PULL_UP */
900 val = (val & BIAS_PU_BIT ? true : false);
901 break;
902
903 case PIN_CONFIG_INPUT_SCHMITT_ENABLE:
904 err = ocelot_hw_get_value(info, pin, PINCONF_SCHMITT, &val);
905 if (err)
906 return err;
907
908 val = (val & SCHMITT_BIT ? true : false);
909 break;
910
911 case PIN_CONFIG_DRIVE_STRENGTH:
912 err = ocelot_hw_get_value(info, pin, PINCONF_DRIVE_STRENGTH,
913 &val);
914 if (err)
915 return err;
916 break;
917
918 case PIN_CONFIG_OUTPUT:
919 err = regmap_read(info->map, REG(OCELOT_GPIO_OUT, info, pin),
920 &val);
921 if (err)
922 return err;
923 val = !!(val & BIT(pin % 32));
924 break;
925
926 case PIN_CONFIG_INPUT_ENABLE:
927 case PIN_CONFIG_OUTPUT_ENABLE:
928 err = regmap_read(info->map, REG(OCELOT_GPIO_OE, info, pin),
929 &val);
930 if (err)
931 return err;
932 val = val & BIT(pin % 32);
933 if (param == PIN_CONFIG_OUTPUT_ENABLE)
934 val = !!val;
935 else
936 val = !val;
937 break;
938
939 default:
940 return -EOPNOTSUPP;
941 }
942
943 *config = pinconf_to_config_packed(param, val);
944
945 return 0;
946}
947
948static int ocelot_pinconf_set(struct pinctrl_dev *pctldev, unsigned int pin,
949 unsigned long *configs, unsigned int num_configs)
950{
951 struct ocelot_pinctrl *info = pinctrl_dev_get_drvdata(pctldev);
952 u32 param, arg, p;
953 int cfg, err = 0;
954
955 for (cfg = 0; cfg < num_configs; cfg++) {
956 param = pinconf_to_config_param(configs[cfg]);
957 arg = pinconf_to_config_argument(configs[cfg]);
958
959 switch (param) {
960 case PIN_CONFIG_BIAS_DISABLE:
961 case PIN_CONFIG_BIAS_PULL_UP:
962 case PIN_CONFIG_BIAS_PULL_DOWN:
963 arg = (param == PIN_CONFIG_BIAS_DISABLE) ? 0 :
964 (param == PIN_CONFIG_BIAS_PULL_UP) ? BIAS_PU_BIT :
965 BIAS_PD_BIT;
966
967 err = ocelot_hw_set_value(info, pin, PINCONF_BIAS, arg);
968 if (err)
969 goto err;
970
971 break;
972
973 case PIN_CONFIG_INPUT_SCHMITT_ENABLE:
974 arg = arg ? SCHMITT_BIT : 0;
975 err = ocelot_hw_set_value(info, pin, PINCONF_SCHMITT,
976 arg);
977 if (err)
978 goto err;
979
980 break;
981
982 case PIN_CONFIG_DRIVE_STRENGTH:
983 err = ocelot_hw_set_value(info, pin,
984 PINCONF_DRIVE_STRENGTH,
985 arg);
986 if (err)
987 goto err;
988
989 break;
990
991 case PIN_CONFIG_OUTPUT_ENABLE:
992 case PIN_CONFIG_INPUT_ENABLE:
993 case PIN_CONFIG_OUTPUT:
994 p = pin % 32;
995 if (arg)
996 regmap_write(info->map,
997 REG(OCELOT_GPIO_OUT_SET, info,
998 pin),
999 BIT(p));
1000 else
1001 regmap_write(info->map,
1002 REG(OCELOT_GPIO_OUT_CLR, info,
1003 pin),
1004 BIT(p));
1005 regmap_update_bits(info->map,
1006 REG(OCELOT_GPIO_OE, info, pin),
1007 BIT(p),
1008 param == PIN_CONFIG_INPUT_ENABLE ?
1009 0 : BIT(p));
1010 break;
1011
1012 default:
1013 err = -EOPNOTSUPP;
1014 }
1015 }
1016err:
1017 return err;
1018}
1019
1020static const struct pinconf_ops ocelot_confops = {
1021 .is_generic = true,
1022 .pin_config_get = ocelot_pinconf_get,
1023 .pin_config_set = ocelot_pinconf_set,
1024 .pin_config_config_dbg_show = pinconf_generic_dump_config,
1025};
1026
ce8dc094
AB		 1027static const struct pinctrl_ops ocelot_pctl_ops = {
1028 .get_groups_count = ocelot_pctl_get_groups_count,
1029 .get_group_name = ocelot_pctl_get_group_name,
1030 .get_group_pins = ocelot_pctl_get_group_pins,
1031 .dt_node_to_map = pinconf_generic_dt_node_to_map_pin,
1032 .dt_free_map = pinconf_generic_dt_free_map,
1033};
1034
8f27440d
LP		 1035static struct pinctrl_desc luton_desc = {
1036 .name = "luton-pinctrl",
1037 .pins = luton_pins,
1038 .npins = ARRAY_SIZE(luton_pins),
1039 .pctlops = &ocelot_pctl_ops,
1040 .pmxops = &ocelot_pmx_ops,
1041 .owner = THIS_MODULE,
1042};
1043
6e6347e2
LP		 1044static struct pinctrl_desc serval_desc = {
1045 .name = "serval-pinctrl",
1046 .pins = serval_pins,
1047 .npins = ARRAY_SIZE(serval_pins),
1048 .pctlops = &ocelot_pctl_ops,
1049 .pmxops = &ocelot_pmx_ops,
1050 .owner = THIS_MODULE,
1051};
1052
ce8dc094
AB		 1053static struct pinctrl_desc ocelot_desc = {
1054 .name = "ocelot-pinctrl",
1055 .pins = ocelot_pins,
1056 .npins = ARRAY_SIZE(ocelot_pins),
1057 .pctlops = &ocelot_pctl_ops,
1058 .pmxops = &ocelot_pmx_ops,
1059 .owner = THIS_MODULE,
1060};
1061
da801ab5
AB		 1062static struct pinctrl_desc jaguar2_desc = {
1063 .name = "jaguar2-pinctrl",
1064 .pins = jaguar2_pins,
1065 .npins = ARRAY_SIZE(jaguar2_pins),
1066 .pctlops = &ocelot_pctl_ops,
1067 .pmxops = &ocelot_pmx_ops,
1068 .owner = THIS_MODULE,
1069};
1070
f8a74760
LP		 1071static struct pinctrl_desc sparx5_desc = {
1072 .name = "sparx5-pinctrl",
1073 .pins = sparx5_pins,
1074 .npins = ARRAY_SIZE(sparx5_pins),
1075 .pctlops = &ocelot_pctl_ops,
1076 .pmxops = &ocelot_pmx_ops,
1077 .confops = &ocelot_confops,
1078 .owner = THIS_MODULE,
1079};
1080
ce8dc094
AB		 1081static int ocelot_create_group_func_map(struct device *dev,
1082 struct ocelot_pinctrl *info)
1083{
ce8dc094 1084 int f, npins, i;
da801ab5
AB		 1085 u8 *pins = kcalloc(info->desc->npins, sizeof(u8), GFP_KERNEL);
1086
1087 if (!pins)
1088 return -ENOMEM;
ce8dc094
AB		 1089
1090 for (f = 0; f < FUNC_MAX; f++) {
da801ab5
AB		 1091 for (npins = 0, i = 0; i < info->desc->npins; i++) {
1092 if (ocelot_pin_function_idx(info, i, f) >= 0)
ce8dc094
AB		 1093 pins[npins++] = i;
1094 }
1095
da801ab5
AB		 1096 if (!npins)
1097 continue;
1098
ce8dc094 1099 info->func[f].ngroups = npins;
da801ab5
AB		 1100 info->func[f].groups = devm_kcalloc(dev, npins, sizeof(char *),
1101 GFP_KERNEL);
1102 if (!info->func[f].groups) {
1103 kfree(pins);
ce8dc094 1104 return -ENOMEM;
da801ab5 1105 }
ce8dc094
AB		 1106
1107 for (i = 0; i < npins; i++)
f8a74760
LP		 1108 info->func[f].groups[i] =
1109 info->desc->pins[pins[i]].name;
ce8dc094
AB		 1110 }
1111
da801ab5
AB		 1112 kfree(pins);
1113
ce8dc094
AB		 1114 return 0;
1115}
1116
1117static int ocelot_pinctrl_register(struct platform_device *pdev,
1118 struct ocelot_pinctrl *info)
1119{
1120 int ret;
1121
1122 ret = ocelot_create_group_func_map(&pdev->dev, info);
1123 if (ret) {
1124 dev_err(&pdev->dev, "Unable to create group func map.\n");
1125 return ret;
1126 }
1127
da801ab5 1128 info->pctl = devm_pinctrl_register(&pdev->dev, info->desc, info);
ce8dc094
AB		 1129 if (IS_ERR(info->pctl)) {
1130 dev_err(&pdev->dev, "Failed to register pinctrl\n");
1131 return PTR_ERR(info->pctl);
1132 }
1133
1134 return 0;
1135}
1136
1137static int ocelot_gpio_get(struct gpio_chip *chip, unsigned int offset)
1138{
1139 struct ocelot_pinctrl *info = gpiochip_get_data(chip);
1140 unsigned int val;
1141
da801ab5 1142 regmap_read(info->map, REG(OCELOT_GPIO_IN, info, offset), &val);
ce8dc094 1143
da801ab5 1144 return !!(val & BIT(offset % 32));
ce8dc094
AB		 1145}
1146
1147static void ocelot_gpio_set(struct gpio_chip *chip, unsigned int offset,
1148 int value)
1149{
1150 struct ocelot_pinctrl *info = gpiochip_get_data(chip);
1151
1152 if (value)
da801ab5
AB		 1153 regmap_write(info->map, REG(OCELOT_GPIO_OUT_SET, info, offset),
1154 BIT(offset % 32));
ce8dc094 1155 else
da801ab5
AB		 1156 regmap_write(info->map, REG(OCELOT_GPIO_OUT_CLR, info, offset),
1157 BIT(offset % 32));
ce8dc094
AB		 1158}
1159
1160static int ocelot_gpio_get_direction(struct gpio_chip *chip,
1161 unsigned int offset)
1162{
1163 struct ocelot_pinctrl *info = gpiochip_get_data(chip);
1164 unsigned int val;
1165
da801ab5 1166 regmap_read(info->map, REG(OCELOT_GPIO_OE, info, offset), &val);
ce8dc094 1167
3c827873
MV		 1168 if (val & BIT(offset % 32))
1169 return GPIO_LINE_DIRECTION_OUT;
1170
1171 return GPIO_LINE_DIRECTION_IN;
ce8dc094
AB		 1172}
1173
1174static int ocelot_gpio_direction_input(struct gpio_chip *chip,
1175 unsigned int offset)
1176{
1177 return pinctrl_gpio_direction_input(chip->base + offset);
1178}
1179
1180static int ocelot_gpio_direction_output(struct gpio_chip *chip,
1181 unsigned int offset, int value)
1182{
1183 struct ocelot_pinctrl *info = gpiochip_get_data(chip);
da801ab5 1184 unsigned int pin = BIT(offset % 32);
ce8dc094
AB		 1185
1186 if (value)
da801ab5
AB		 1187 regmap_write(info->map, REG(OCELOT_GPIO_OUT_SET, info, offset),
1188 pin);
ce8dc094 1189 else
da801ab5
AB		 1190 regmap_write(info->map, REG(OCELOT_GPIO_OUT_CLR, info, offset),
1191 pin);
ce8dc094
AB		 1192
1193 return pinctrl_gpio_direction_output(chip->base + offset);
1194}
1195
1196static const struct gpio_chip ocelot_gpiolib_chip = {
1197 .request = gpiochip_generic_request,
1198 .free = gpiochip_generic_free,
1199 .set = ocelot_gpio_set,
1200 .get = ocelot_gpio_get,
1201 .get_direction = ocelot_gpio_get_direction,
1202 .direction_input = ocelot_gpio_direction_input,
1203 .direction_output = ocelot_gpio_direction_output,
1204 .owner = THIS_MODULE,
1205};
1206
be36abb7
QS		 1207static void ocelot_irq_mask(struct irq_data *data)
1208{
1209 struct gpio_chip *chip = irq_data_get_irq_chip_data(data);
1210 struct ocelot_pinctrl *info = gpiochip_get_data(chip);
1211 unsigned int gpio = irqd_to_hwirq(data);
1212
da801ab5
AB		 1213 regmap_update_bits(info->map, REG(OCELOT_GPIO_INTR_ENA, info, gpio),
1214 BIT(gpio % 32), 0);
be36abb7
QS		 1215}
1216
1217static void ocelot_irq_unmask(struct irq_data *data)
1218{
1219 struct gpio_chip *chip = irq_data_get_irq_chip_data(data);
1220 struct ocelot_pinctrl *info = gpiochip_get_data(chip);
1221 unsigned int gpio = irqd_to_hwirq(data);
1222
da801ab5
AB		 1223 regmap_update_bits(info->map, REG(OCELOT_GPIO_INTR_ENA, info, gpio),
1224 BIT(gpio % 32), BIT(gpio % 32));
be36abb7
QS		 1225}
1226
1227static void ocelot_irq_ack(struct irq_data *data)
1228{
1229 struct gpio_chip *chip = irq_data_get_irq_chip_data(data);
1230 struct ocelot_pinctrl *info = gpiochip_get_data(chip);
1231 unsigned int gpio = irqd_to_hwirq(data);
1232
da801ab5
AB		 1233 regmap_write_bits(info->map, REG(OCELOT_GPIO_INTR, info, gpio),
1234 BIT(gpio % 32), BIT(gpio % 32));
be36abb7
QS		 1235}
1236
1237static int ocelot_irq_set_type(struct irq_data *data, unsigned int type);
1238
1239static struct irq_chip ocelot_eoi_irqchip = {
1240 .name = "gpio",
1241 .irq_mask = ocelot_irq_mask,
1242 .irq_eoi = ocelot_irq_ack,
1243 .irq_unmask = ocelot_irq_unmask,
1244 .flags = IRQCHIP_EOI_THREADED | IRQCHIP_EOI_IF_HANDLED,
1245 .irq_set_type = ocelot_irq_set_type,
1246};
1247
1248static struct irq_chip ocelot_irqchip = {
1249 .name = "gpio",
1250 .irq_mask = ocelot_irq_mask,
1251 .irq_ack = ocelot_irq_ack,
1252 .irq_unmask = ocelot_irq_unmask,
1253 .irq_set_type = ocelot_irq_set_type,
1254};
1255
1256static int ocelot_irq_set_type(struct irq_data *data, unsigned int type)
1257{
1258 type &= IRQ_TYPE_SENSE_MASK;
1259
1260 if (!(type & (IRQ_TYPE_EDGE_BOTH | IRQ_TYPE_LEVEL_HIGH)))
1261 return -EINVAL;
1262
1263 if (type & IRQ_TYPE_LEVEL_HIGH)
1264 irq_set_chip_handler_name_locked(data, &ocelot_eoi_irqchip,
1265 handle_fasteoi_irq, NULL);
1266 if (type & IRQ_TYPE_EDGE_BOTH)
1267 irq_set_chip_handler_name_locked(data, &ocelot_irqchip,
1268 handle_edge_irq, NULL);
1269
1270 return 0;
1271}
1272
1273static void ocelot_irq_handler(struct irq_desc *desc)
1274{
1275 struct irq_chip *parent_chip = irq_desc_get_chip(desc);
1276 struct gpio_chip *chip = irq_desc_get_handler_data(desc);
1277 struct ocelot_pinctrl *info = gpiochip_get_data(chip);
0b47afc6 1278 unsigned int id_reg = OCELOT_GPIO_INTR_IDENT * info->stride;
da801ab5 1279 unsigned int reg = 0, irq, i;
be36abb7
QS		 1280 unsigned long irqs;
1281
da801ab5 1282 for (i = 0; i < info->stride; i++) {
0b47afc6 1283 regmap_read(info->map, id_reg + 4 * i, &reg);
da801ab5
AB		 1284 if (!reg)
1285 continue;
be36abb7 1286
da801ab5 1287 chained_irq_enter(parent_chip, desc);
be36abb7 1288
da801ab5 1289 irqs = reg;
be36abb7 1290
da801ab5
AB		 1291 for_each_set_bit(irq, &irqs,
1292 min(32U, info->desc->npins - 32 * i))
1293 generic_handle_irq(irq_linear_revmap(chip->irq.domain,
1294 irq + 32 * i));
be36abb7 1295
da801ab5
AB		 1296 chained_irq_exit(parent_chip, desc);
1297 }
be36abb7
QS		 1298}
1299
ce8dc094
AB		 1300static int ocelot_gpiochip_register(struct platform_device *pdev,
1301 struct ocelot_pinctrl *info)
1302{
1303 struct gpio_chip *gc;
d874beca 1304 struct gpio_irq_chip *girq;
17f2c8d3 1305 int irq;
ce8dc094
AB		 1306
1307 info->gpio_chip = ocelot_gpiolib_chip;
1308
1309 gc = &info->gpio_chip;
da801ab5 1310 gc->ngpio = info->desc->npins;
ce8dc094
AB		 1311 gc->parent = &pdev->dev;
1312 gc->base = 0;
1313 gc->of_node = info->dev->of_node;
1314 gc->label = "ocelot-gpio";
1315
550713e3
LP		 1316 irq = irq_of_parse_and_map(gc->of_node, 0);
1317 if (irq) {
1318 girq = &gc->irq;
1319 girq->chip = &ocelot_irqchip;
1320 girq->parent_handler = ocelot_irq_handler;
1321 girq->num_parents = 1;
1322 girq->parents = devm_kcalloc(&pdev->dev, 1,
1323 sizeof(*girq->parents),
1324 GFP_KERNEL);
1325 if (!girq->parents)
1326 return -ENOMEM;
1327 girq->parents[0] = irq;
1328 girq->default_type = IRQ_TYPE_NONE;
1329 girq->handler = handle_edge_irq;
1330 }
d874beca 1331
17f2c8d3 1332 return devm_gpiochip_add_data(&pdev->dev, gc, info);
ce8dc094
AB		 1333}
1334
ce8dc094 1335static const struct of_device_id ocelot_pinctrl_of_match[] = {
8f27440d 1336 { .compatible = "mscc,luton-pinctrl", .data = &luton_desc },
6e6347e2 1337 { .compatible = "mscc,serval-pinctrl", .data = &serval_desc },
da801ab5
AB		 1338 { .compatible = "mscc,ocelot-pinctrl", .data = &ocelot_desc },
1339 { .compatible = "mscc,jaguar2-pinctrl", .data = &jaguar2_desc },
f8a74760 1340 { .compatible = "microchip,sparx5-pinctrl", .data = &sparx5_desc },
ce8dc094
AB		 1341 {},
1342};
1343
ce3e7f0e 1344static int ocelot_pinctrl_probe(struct platform_device *pdev)
ce8dc094
AB		 1345{
1346 struct device *dev = &pdev->dev;
1347 struct ocelot_pinctrl *info;
1348 void __iomem *base;
f8a74760 1349 struct resource *res;
ce8dc094 1350 int ret;
da801ab5
AB		 1351 struct regmap_config regmap_config = {
1352 .reg_bits = 32,
1353 .val_bits = 32,
1354 .reg_stride = 4,
1355 };
ce8dc094
AB		 1356
1357 info = devm_kzalloc(dev, sizeof(*info), GFP_KERNEL);
1358 if (!info)
1359 return -ENOMEM;
1360
da801ab5
AB		 1361 info->desc = (struct pinctrl_desc *)device_get_match_data(dev);
1362
ce8dc094
AB		 1363 base = devm_ioremap_resource(dev,
1364 platform_get_resource(pdev, IORESOURCE_MEM, 0));
0f9facdb 1365 if (IS_ERR(base))
ce8dc094 1366 return PTR_ERR(base);
ce8dc094 1367
da801ab5 1368 info->stride = 1 + (info->desc->npins - 1) / 32;
f8a74760 1369
da801ab5
AB		 1370 regmap_config.max_register = OCELOT_GPIO_SD_MAP * info->stride + 15 * 4;
1371
1372 info->map = devm_regmap_init_mmio(dev, base, &regmap_config);
ce8dc094
AB		 1373 if (IS_ERR(info->map)) {
1374 dev_err(dev, "Failed to create regmap\n");
1375 return PTR_ERR(info->map);
1376 }
1377 dev_set_drvdata(dev, info->map);
1378 info->dev = dev;
1379
f8a74760
LP		 1380 /* Pinconf registers */
1381 if (info->desc->confops) {
1382 res = platform_get_resource(pdev, IORESOURCE_MEM, 1);
1383 base = devm_ioremap_resource(dev, res);
1384 if (IS_ERR(base))
1385 dev_dbg(dev, "Failed to ioremap config registers (no extended pinconf)\n");
1386 else
1387 info->pincfg = base;
1388 }
1389
ce8dc094
AB		 1390 ret = ocelot_pinctrl_register(pdev, info);
1391 if (ret)
1392 return ret;
1393
1394 ret = ocelot_gpiochip_register(pdev, info);
1395 if (ret)
1396 return ret;
1397
f8a74760
LP		 1398 dev_info(dev, "driver registered\n");
1399
ce8dc094
AB		 1400 return 0;
1401}
1402
1403static struct platform_driver ocelot_pinctrl_driver = {
1404 .driver = {
1405 .name = "pinctrl-ocelot",
1406 .of_match_table = of_match_ptr(ocelot_pinctrl_of_match),
1407 .suppress_bind_attrs = true,
1408 },
1409 .probe = ocelot_pinctrl_probe,
1410};
1411builtin_platform_driver(ocelot_pinctrl_driver);
Linux 6.x block layer and io_uring tree(s)