1
2
3
4
5
6
7
8
9
10#include <linux/gpio/driver.h>
11#include <linux/interrupt.h>
12#include <linux/io.h>
13#include <linux/of_device.h>
14#include <linux/of_irq.h>
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
28#define ocelot_clrsetbits(addr, clear, set) \
29 writel((readl(addr) & ~(clear)) | (set), (addr))
30
31
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
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
57#define OCELOT_FUNC_PER_PIN 4
58
59enum {
60 FUNC_NONE,
61 FUNC_GPIO,
62 FUNC_IRQ0,
63 FUNC_IRQ0_IN,
64 FUNC_IRQ0_OUT,
65 FUNC_IRQ1,
66 FUNC_IRQ1_IN,
67 FUNC_IRQ1_OUT,
68 FUNC_EXT_IRQ,
69 FUNC_MIIM,
70 FUNC_PHY_LED,
71 FUNC_PCI_WAKE,
72 FUNC_MD,
73 FUNC_PTP0,
74 FUNC_PTP1,
75 FUNC_PTP2,
76 FUNC_PTP3,
77 FUNC_PWM,
78 FUNC_RECO_CLK,
79 FUNC_SFP,
80 FUNC_SG0,
81 FUNC_SG1,
82 FUNC_SG2,
83 FUNC_SI,
84 FUNC_SI2,
85 FUNC_TACHO,
86 FUNC_TWI,
87 FUNC_TWI2,
88 FUNC_TWI3,
89 FUNC_TWI_SCL_M,
90 FUNC_UART,
91 FUNC_UART2,
92 FUNC_UART3,
93 FUNC_PLL_STAT,
94 FUNC_EMMC,
95 FUNC_REF_CLK,
96 FUNC_RCVRD_CLK,
97 FUNC_MAX
98};
99
100static const char *const ocelot_function_names[] = {
101 [FUNC_NONE] = "none",
102 [FUNC_GPIO] = "gpio",
103 [FUNC_IRQ0] = "irq0",
104 [FUNC_IRQ0_IN] = "irq0_in",
105 [FUNC_IRQ0_OUT] = "irq0_out",
106 [FUNC_IRQ1] = "irq1",
107 [FUNC_IRQ1_IN] = "irq1_in",
108 [FUNC_IRQ1_OUT] = "irq1_out",
109 [FUNC_EXT_IRQ] = "ext_irq",
110 [FUNC_MIIM] = "miim",
111 [FUNC_PHY_LED] = "phy_led",
112 [FUNC_PCI_WAKE] = "pci_wake",
113 [FUNC_MD] = "md",
114 [FUNC_PTP0] = "ptp0",
115 [FUNC_PTP1] = "ptp1",
116 [FUNC_PTP2] = "ptp2",
117 [FUNC_PTP3] = "ptp3",
118 [FUNC_PWM] = "pwm",
119 [FUNC_RECO_CLK] = "reco_clk",
120 [FUNC_SFP] = "sfp",
121 [FUNC_SG0] = "sg0",
122 [FUNC_SG1] = "sg1",
123 [FUNC_SG2] = "sg2",
124 [FUNC_SI] = "si",
125 [FUNC_SI2] = "si2",
126 [FUNC_TACHO] = "tacho",
127 [FUNC_TWI] = "twi",
128 [FUNC_TWI2] = "twi2",
129 [FUNC_TWI3] = "twi3",
130 [FUNC_TWI_SCL_M] = "twi_scl_m",
131 [FUNC_UART] = "uart",
132 [FUNC_UART2] = "uart2",
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",
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;
155 void __iomem *pincfg;
156 struct pinctrl_desc *desc;
157 struct ocelot_pmx_func func[FUNC_MAX];
158 u8 stride;
159};
160
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
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
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);
337OCELOT_P(4, IRQ0_IN, IRQ0_OUT, TWI_SCL_M);
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);
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);
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);
353OCELOT_P(20, RECO_CLK, TACHO, TWI_SCL_M);
354OCELOT_P(21, RECO_CLK, PWM, TWI_SCL_M);
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
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);
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);
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
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
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
703static int ocelot_pin_function_idx(struct ocelot_pinctrl *info,
704 unsigned int pin, unsigned int function)
705{
706 struct ocelot_pin_caps *p = info->desc->pins[pin].drv_data;
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
717#define REG_ALT(msb, info, p) (OCELOT_GPIO_ALT0 * (info)->stride + 4 * ((msb) + ((info)->stride * ((p) / 32))))
718
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);
723 struct ocelot_pin_caps *pin = info->desc->pins[group].drv_data;
724 unsigned int p = pin->pin % 32;
725 int f;
726
727 f = ocelot_pin_function_idx(info, group, selector);
728 if (f < 0)
729 return -EINVAL;
730
731
732
733
734
735
736
737
738
739 regmap_update_bits(info->map, REG_ALT(0, info, pin->pin),
740 BIT(p), f << p);
741 regmap_update_bits(info->map, REG_ALT(1, info, pin->pin),
742 BIT(p), f << (p - 1));
743
744 return 0;
745}
746
747#define REG(r, info, p) ((r) * (info)->stride + (4 * ((p) / 32)))
748
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);
754 unsigned int p = pin % 32;
755
756 regmap_update_bits(info->map, REG(OCELOT_GPIO_OE, info, pin), BIT(p),
757 input ? 0 : BIT(p));
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);
767 unsigned int p = offset % 32;
768
769 regmap_update_bits(info->map, REG_ALT(0, info, offset),
770 BIT(p), 0);
771 regmap_update_bits(info->map, REG_ALT(1, info, offset),
772 BIT(p), 0);
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{
788 struct ocelot_pinctrl *info = pinctrl_dev_get_drvdata(pctldev);
789
790 return info->desc->npins;
791}
792
793static const char *ocelot_pctl_get_group_name(struct pinctrl_dev *pctldev,
794 unsigned int group)
795{
796 struct ocelot_pinctrl *info = pinctrl_dev_get_drvdata(pctldev);
797
798 return info->desc->pins[group].name;
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{
806 struct ocelot_pinctrl *info = pinctrl_dev_get_drvdata(pctldev);
807
808 *pins = &info->desc->pins[group].number;
809 *num_pins = 1;
810
811 return 0;
812}
813
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)
896 val = (val == 0);
897 else if (param == PIN_CONFIG_BIAS_PULL_DOWN)
898 val = (val & BIAS_PD_BIT ? true : false);
899 else
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
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
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
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
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
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
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
1081static int ocelot_create_group_func_map(struct device *dev,
1082 struct ocelot_pinctrl *info)
1083{
1084 int f, npins, i;
1085 u8 *pins = kcalloc(info->desc->npins, sizeof(u8), GFP_KERNEL);
1086
1087 if (!pins)
1088 return -ENOMEM;
1089
1090 for (f = 0; f < FUNC_MAX; f++) {
1091 for (npins = 0, i = 0; i < info->desc->npins; i++) {
1092 if (ocelot_pin_function_idx(info, i, f) >= 0)
1093 pins[npins++] = i;
1094 }
1095
1096 if (!npins)
1097 continue;
1098
1099 info->func[f].ngroups = npins;
1100 info->func[f].groups = devm_kcalloc(dev, npins, sizeof(char *),
1101 GFP_KERNEL);
1102 if (!info->func[f].groups) {
1103 kfree(pins);
1104 return -ENOMEM;
1105 }
1106
1107 for (i = 0; i < npins; i++)
1108 info->func[f].groups[i] =
1109 info->desc->pins[pins[i]].name;
1110 }
1111
1112 kfree(pins);
1113
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
1128 info->pctl = devm_pinctrl_register(&pdev->dev, info->desc, info);
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
1142 regmap_read(info->map, REG(OCELOT_GPIO_IN, info, offset), &val);
1143
1144 return !!(val & BIT(offset % 32));
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)
1153 regmap_write(info->map, REG(OCELOT_GPIO_OUT_SET, info, offset),
1154 BIT(offset % 32));
1155 else
1156 regmap_write(info->map, REG(OCELOT_GPIO_OUT_CLR, info, offset),
1157 BIT(offset % 32));
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
1166 regmap_read(info->map, REG(OCELOT_GPIO_OE, info, offset), &val);
1167
1168 if (val & BIT(offset % 32))
1169 return GPIO_LINE_DIRECTION_OUT;
1170
1171 return GPIO_LINE_DIRECTION_IN;
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);
1184 unsigned int pin = BIT(offset % 32);
1185
1186 if (value)
1187 regmap_write(info->map, REG(OCELOT_GPIO_OUT_SET, info, offset),
1188 pin);
1189 else
1190 regmap_write(info->map, REG(OCELOT_GPIO_OUT_CLR, info, offset),
1191 pin);
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
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
1213 regmap_update_bits(info->map, REG(OCELOT_GPIO_INTR_ENA, info, gpio),
1214 BIT(gpio % 32), 0);
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
1223 regmap_update_bits(info->map, REG(OCELOT_GPIO_INTR_ENA, info, gpio),
1224 BIT(gpio % 32), BIT(gpio % 32));
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
1233 regmap_write_bits(info->map, REG(OCELOT_GPIO_INTR, info, gpio),
1234 BIT(gpio % 32), BIT(gpio % 32));
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);
1278 unsigned int id_reg = OCELOT_GPIO_INTR_IDENT * info->stride;
1279 unsigned int reg = 0, irq, i;
1280 unsigned long irqs;
1281
1282 for (i = 0; i < info->stride; i++) {
1283 regmap_read(info->map, id_reg + 4 * i, ®);
1284 if (!reg)
1285 continue;
1286
1287 chained_irq_enter(parent_chip, desc);
1288
1289 irqs = reg;
1290
1291 for_each_set_bit(irq, &irqs,
1292 min(32U, info->desc->npins - 32 * i))
1293 generic_handle_domain_irq(chip->irq.domain, irq + 32 * i);
1294
1295 chained_irq_exit(parent_chip, desc);
1296 }
1297}
1298
1299static int ocelot_gpiochip_register(struct platform_device *pdev,
1300 struct ocelot_pinctrl *info)
1301{
1302 struct gpio_chip *gc;
1303 struct gpio_irq_chip *girq;
1304 int irq;
1305
1306 info->gpio_chip = ocelot_gpiolib_chip;
1307
1308 gc = &info->gpio_chip;
1309 gc->ngpio = info->desc->npins;
1310 gc->parent = &pdev->dev;
1311 gc->base = 0;
1312 gc->of_node = info->dev->of_node;
1313 gc->label = "ocelot-gpio";
1314
1315 irq = irq_of_parse_and_map(gc->of_node, 0);
1316 if (irq) {
1317 girq = &gc->irq;
1318 girq->chip = &ocelot_irqchip;
1319 girq->parent_handler = ocelot_irq_handler;
1320 girq->num_parents = 1;
1321 girq->parents = devm_kcalloc(&pdev->dev, 1,
1322 sizeof(*girq->parents),
1323 GFP_KERNEL);
1324 if (!girq->parents)
1325 return -ENOMEM;
1326 girq->parents[0] = irq;
1327 girq->default_type = IRQ_TYPE_NONE;
1328 girq->handler = handle_edge_irq;
1329 }
1330
1331 return devm_gpiochip_add_data(&pdev->dev, gc, info);
1332}
1333
1334static const struct of_device_id ocelot_pinctrl_of_match[] = {
1335 { .compatible = "mscc,luton-pinctrl", .data = &luton_desc },
1336 { .compatible = "mscc,serval-pinctrl", .data = &serval_desc },
1337 { .compatible = "mscc,ocelot-pinctrl", .data = &ocelot_desc },
1338 { .compatible = "mscc,jaguar2-pinctrl", .data = &jaguar2_desc },
1339 { .compatible = "microchip,sparx5-pinctrl", .data = &sparx5_desc },
1340 {},
1341};
1342
1343static int ocelot_pinctrl_probe(struct platform_device *pdev)
1344{
1345 struct device *dev = &pdev->dev;
1346 struct ocelot_pinctrl *info;
1347 void __iomem *base;
1348 struct resource *res;
1349 int ret;
1350 struct regmap_config regmap_config = {
1351 .reg_bits = 32,
1352 .val_bits = 32,
1353 .reg_stride = 4,
1354 };
1355
1356 info = devm_kzalloc(dev, sizeof(*info), GFP_KERNEL);
1357 if (!info)
1358 return -ENOMEM;
1359
1360 info->desc = (struct pinctrl_desc *)device_get_match_data(dev);
1361
1362 base = devm_ioremap_resource(dev,
1363 platform_get_resource(pdev, IORESOURCE_MEM, 0));
1364 if (IS_ERR(base))
1365 return PTR_ERR(base);
1366
1367 info->stride = 1 + (info->desc->npins - 1) / 32;
1368
1369 regmap_config.max_register = OCELOT_GPIO_SD_MAP * info->stride + 15 * 4;
1370
1371 info->map = devm_regmap_init_mmio(dev, base, ®map_config);
1372 if (IS_ERR(info->map)) {
1373 dev_err(dev, "Failed to create regmap\n");
1374 return PTR_ERR(info->map);
1375 }
1376 dev_set_drvdata(dev, info->map);
1377 info->dev = dev;
1378
1379
1380 if (info->desc->confops) {
1381 res = platform_get_resource(pdev, IORESOURCE_MEM, 1);
1382 base = devm_ioremap_resource(dev, res);
1383 if (IS_ERR(base))
1384 dev_dbg(dev, "Failed to ioremap config registers (no extended pinconf)\n");
1385 else
1386 info->pincfg = base;
1387 }
1388
1389 ret = ocelot_pinctrl_register(pdev, info);
1390 if (ret)
1391 return ret;
1392
1393 ret = ocelot_gpiochip_register(pdev, info);
1394 if (ret)
1395 return ret;
1396
1397 dev_info(dev, "driver registered\n");
1398
1399 return 0;
1400}
1401
1402static struct platform_driver ocelot_pinctrl_driver = {
1403 .driver = {
1404 .name = "pinctrl-ocelot",
1405 .of_match_table = of_match_ptr(ocelot_pinctrl_of_match),
1406 .suppress_bind_attrs = true,
1407 },
1408 .probe = ocelot_pinctrl_probe,
1409};
1410builtin_platform_driver(ocelot_pinctrl_driver);
1411