1 // SPDX-License-Identifier: (GPL-2.0 OR MIT)
3 * Microsemi SoCs pinctrl driver
5 * Author: <alexandre.belloni@free-electrons.com>
6 * License: Dual MIT/GPL
7 * Copyright (c) 2017 Microsemi Corporation
10 #include <linux/gpio/driver.h>
11 #include <linux/interrupt.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/reset.h>
23 #include <linux/slab.h>
29 #define ocelot_clrsetbits(addr, clear, set) \
30 writel((readl(addr) & ~(clear)) | (set), (addr))
35 PINCONF_DRIVE_STRENGTH,
38 /* GPIO standard registers */
39 #define OCELOT_GPIO_OUT_SET 0x0
40 #define OCELOT_GPIO_OUT_CLR 0x4
41 #define OCELOT_GPIO_OUT 0x8
42 #define OCELOT_GPIO_IN 0xc
43 #define OCELOT_GPIO_OE 0x10
44 #define OCELOT_GPIO_INTR 0x14
45 #define OCELOT_GPIO_INTR_ENA 0x18
46 #define OCELOT_GPIO_INTR_IDENT 0x1c
47 #define OCELOT_GPIO_ALT0 0x20
48 #define OCELOT_GPIO_ALT1 0x24
49 #define OCELOT_GPIO_SD_MAP 0x28
51 #define OCELOT_FUNC_PER_PIN 4
162 FUNC_TWI_SLC_GATE_AD,
180 static const char *const ocelot_function_names[] = {
181 [FUNC_CAN0_a] = "can0_a",
182 [FUNC_CAN0_b] = "can0_b",
183 [FUNC_CAN1] = "can1",
184 [FUNC_CLKMON] = "clkmon",
185 [FUNC_NONE] = "none",
186 [FUNC_FC0_a] = "fc0_a",
187 [FUNC_FC0_b] = "fc0_b",
188 [FUNC_FC0_c] = "fc0_c",
189 [FUNC_FC1_a] = "fc1_a",
190 [FUNC_FC1_b] = "fc1_b",
191 [FUNC_FC1_c] = "fc1_c",
192 [FUNC_FC2_a] = "fc2_a",
193 [FUNC_FC2_b] = "fc2_b",
194 [FUNC_FC3_a] = "fc3_a",
195 [FUNC_FC3_b] = "fc3_b",
196 [FUNC_FC3_c] = "fc3_c",
197 [FUNC_FC4_a] = "fc4_a",
198 [FUNC_FC4_b] = "fc4_b",
199 [FUNC_FC4_c] = "fc4_c",
200 [FUNC_FC_SHRD0] = "fc_shrd0",
201 [FUNC_FC_SHRD1] = "fc_shrd1",
202 [FUNC_FC_SHRD2] = "fc_shrd2",
203 [FUNC_FC_SHRD3] = "fc_shrd3",
204 [FUNC_FC_SHRD4] = "fc_shrd4",
205 [FUNC_FC_SHRD5] = "fc_shrd5",
206 [FUNC_FC_SHRD6] = "fc_shrd6",
207 [FUNC_FC_SHRD7] = "fc_shrd7",
208 [FUNC_FC_SHRD8] = "fc_shrd8",
209 [FUNC_FC_SHRD9] = "fc_shrd9",
210 [FUNC_FC_SHRD10] = "fc_shrd10",
211 [FUNC_FC_SHRD11] = "fc_shrd11",
212 [FUNC_FC_SHRD12] = "fc_shrd12",
213 [FUNC_FC_SHRD13] = "fc_shrd13",
214 [FUNC_FC_SHRD14] = "fc_shrd14",
215 [FUNC_FC_SHRD15] = "fc_shrd15",
216 [FUNC_FC_SHRD16] = "fc_shrd16",
217 [FUNC_FC_SHRD17] = "fc_shrd17",
218 [FUNC_FC_SHRD18] = "fc_shrd18",
219 [FUNC_FC_SHRD19] = "fc_shrd19",
220 [FUNC_FC_SHRD20] = "fc_shrd20",
221 [FUNC_GPIO] = "gpio",
222 [FUNC_IB_TRG_a] = "ib_trig_a",
223 [FUNC_IB_TRG_b] = "ib_trig_b",
224 [FUNC_IB_TRG_c] = "ib_trig_c",
225 [FUNC_IRQ0] = "irq0",
226 [FUNC_IRQ_IN_a] = "irq_in_a",
227 [FUNC_IRQ_IN_b] = "irq_in_b",
228 [FUNC_IRQ_IN_c] = "irq_in_c",
229 [FUNC_IRQ0_IN] = "irq0_in",
230 [FUNC_IRQ_OUT_a] = "irq_out_a",
231 [FUNC_IRQ_OUT_b] = "irq_out_b",
232 [FUNC_IRQ_OUT_c] = "irq_out_c",
233 [FUNC_IRQ0_OUT] = "irq0_out",
234 [FUNC_IRQ1] = "irq1",
235 [FUNC_IRQ1_IN] = "irq1_in",
236 [FUNC_IRQ1_OUT] = "irq1_out",
237 [FUNC_EXT_IRQ] = "ext_irq",
238 [FUNC_MIIM] = "miim",
239 [FUNC_MIIM_a] = "miim_a",
240 [FUNC_MIIM_b] = "miim_b",
241 [FUNC_MIIM_c] = "miim_c",
242 [FUNC_MIIM_Sa] = "miim_slave_a",
243 [FUNC_MIIM_Sb] = "miim_slave_b",
244 [FUNC_PHY_LED] = "phy_led",
245 [FUNC_PCI_WAKE] = "pci_wake",
247 [FUNC_OB_TRG] = "ob_trig",
248 [FUNC_OB_TRG_a] = "ob_trig_a",
249 [FUNC_OB_TRG_b] = "ob_trig_b",
250 [FUNC_PTP0] = "ptp0",
251 [FUNC_PTP1] = "ptp1",
252 [FUNC_PTP2] = "ptp2",
253 [FUNC_PTP3] = "ptp3",
254 [FUNC_PTPSYNC_0] = "ptpsync_0",
255 [FUNC_PTPSYNC_1] = "ptpsync_1",
256 [FUNC_PTPSYNC_2] = "ptpsync_2",
257 [FUNC_PTPSYNC_3] = "ptpsync_3",
258 [FUNC_PTPSYNC_4] = "ptpsync_4",
259 [FUNC_PTPSYNC_5] = "ptpsync_5",
260 [FUNC_PTPSYNC_6] = "ptpsync_6",
261 [FUNC_PTPSYNC_7] = "ptpsync_7",
263 [FUNC_PWM_a] = "pwm_a",
264 [FUNC_PWM_b] = "pwm_b",
265 [FUNC_QSPI1] = "qspi1",
266 [FUNC_QSPI2] = "qspi2",
267 [FUNC_R] = "reserved",
268 [FUNC_RECO_a] = "reco_a",
269 [FUNC_RECO_b] = "reco_b",
270 [FUNC_RECO_CLK] = "reco_clk",
273 [FUNC_SFP_SD] = "sfp_sd",
277 [FUNC_SGPIO_a] = "sgpio_a",
278 [FUNC_SGPIO_b] = "sgpio_b",
281 [FUNC_TACHO] = "tacho",
282 [FUNC_TACHO_a] = "tacho_a",
283 [FUNC_TACHO_b] = "tacho_b",
285 [FUNC_TWI2] = "twi2",
286 [FUNC_TWI3] = "twi3",
287 [FUNC_TWI_SCL_M] = "twi_scl_m",
288 [FUNC_TWI_SLC_GATE] = "twi_slc_gate",
289 [FUNC_TWI_SLC_GATE_AD] = "twi_slc_gate_ad",
290 [FUNC_USB_H_a] = "usb_host_a",
291 [FUNC_USB_H_b] = "usb_host_b",
292 [FUNC_USB_H_c] = "usb_host_c",
293 [FUNC_USB_S_a] = "usb_slave_a",
294 [FUNC_USB_S_b] = "usb_slave_b",
295 [FUNC_USB_S_c] = "usb_slave_c",
296 [FUNC_UART] = "uart",
297 [FUNC_UART2] = "uart2",
298 [FUNC_UART3] = "uart3",
299 [FUNC_PLL_STAT] = "pll_stat",
300 [FUNC_EMMC] = "emmc",
301 [FUNC_EMMC_SD] = "emmc_sd",
302 [FUNC_REF_CLK] = "ref_clk",
303 [FUNC_RCVRD_CLK] = "rcvrd_clk",
306 struct ocelot_pmx_func {
308 unsigned int ngroups;
311 struct ocelot_pin_caps {
313 unsigned char functions[OCELOT_FUNC_PER_PIN];
314 unsigned char a_functions[OCELOT_FUNC_PER_PIN]; /* Additional functions */
317 struct ocelot_pincfg_data {
324 struct ocelot_pinctrl {
326 struct pinctrl_dev *pctl;
327 struct gpio_chip gpio_chip;
329 struct regmap *pincfg;
330 struct pinctrl_desc *desc;
331 const struct ocelot_pincfg_data *pincfg_data;
332 struct ocelot_pmx_func func[FUNC_MAX];
336 struct ocelot_match_data {
337 struct pinctrl_desc desc;
338 struct ocelot_pincfg_data pincfg_data;
341 #define LUTON_P(p, f0, f1) \
342 static struct ocelot_pin_caps luton_pin_##p = { \
345 FUNC_GPIO, FUNC_##f0, FUNC_##f1, FUNC_NONE, \
349 LUTON_P(0, SG0, NONE);
350 LUTON_P(1, SG0, NONE);
351 LUTON_P(2, SG0, NONE);
352 LUTON_P(3, SG0, NONE);
353 LUTON_P(4, TACHO, NONE);
354 LUTON_P(5, TWI, PHY_LED);
355 LUTON_P(6, TWI, PHY_LED);
356 LUTON_P(7, NONE, PHY_LED);
357 LUTON_P(8, EXT_IRQ, PHY_LED);
358 LUTON_P(9, EXT_IRQ, PHY_LED);
359 LUTON_P(10, SFP, PHY_LED);
360 LUTON_P(11, SFP, PHY_LED);
361 LUTON_P(12, SFP, PHY_LED);
362 LUTON_P(13, SFP, PHY_LED);
363 LUTON_P(14, SI, PHY_LED);
364 LUTON_P(15, SI, PHY_LED);
365 LUTON_P(16, SI, PHY_LED);
366 LUTON_P(17, SFP, PHY_LED);
367 LUTON_P(18, SFP, PHY_LED);
368 LUTON_P(19, SFP, PHY_LED);
369 LUTON_P(20, SFP, PHY_LED);
370 LUTON_P(21, SFP, PHY_LED);
371 LUTON_P(22, SFP, PHY_LED);
372 LUTON_P(23, SFP, PHY_LED);
373 LUTON_P(24, SFP, PHY_LED);
374 LUTON_P(25, SFP, PHY_LED);
375 LUTON_P(26, SFP, PHY_LED);
376 LUTON_P(27, SFP, PHY_LED);
377 LUTON_P(28, SFP, PHY_LED);
378 LUTON_P(29, PWM, NONE);
379 LUTON_P(30, UART, NONE);
380 LUTON_P(31, UART, NONE);
382 #define LUTON_PIN(n) { \
385 .drv_data = &luton_pin_##n \
388 static const struct pinctrl_pin_desc luton_pins[] = {
423 #define SERVAL_P(p, f0, f1, f2) \
424 static struct ocelot_pin_caps serval_pin_##p = { \
427 FUNC_GPIO, FUNC_##f0, FUNC_##f1, FUNC_##f2, \
431 SERVAL_P(0, SG0, NONE, NONE);
432 SERVAL_P(1, SG0, NONE, NONE);
433 SERVAL_P(2, SG0, NONE, NONE);
434 SERVAL_P(3, SG0, NONE, NONE);
435 SERVAL_P(4, TACHO, NONE, NONE);
436 SERVAL_P(5, PWM, NONE, NONE);
437 SERVAL_P(6, TWI, NONE, NONE);
438 SERVAL_P(7, TWI, NONE, NONE);
439 SERVAL_P(8, SI, NONE, NONE);
440 SERVAL_P(9, SI, MD, NONE);
441 SERVAL_P(10, SI, MD, NONE);
442 SERVAL_P(11, SFP, MD, TWI_SCL_M);
443 SERVAL_P(12, SFP, MD, TWI_SCL_M);
444 SERVAL_P(13, SFP, UART2, TWI_SCL_M);
445 SERVAL_P(14, SFP, UART2, TWI_SCL_M);
446 SERVAL_P(15, SFP, PTP0, TWI_SCL_M);
447 SERVAL_P(16, SFP, PTP0, TWI_SCL_M);
448 SERVAL_P(17, SFP, PCI_WAKE, TWI_SCL_M);
449 SERVAL_P(18, SFP, NONE, TWI_SCL_M);
450 SERVAL_P(19, SFP, NONE, TWI_SCL_M);
451 SERVAL_P(20, SFP, NONE, TWI_SCL_M);
452 SERVAL_P(21, SFP, NONE, TWI_SCL_M);
453 SERVAL_P(22, NONE, NONE, NONE);
454 SERVAL_P(23, NONE, NONE, NONE);
455 SERVAL_P(24, NONE, NONE, NONE);
456 SERVAL_P(25, NONE, NONE, NONE);
457 SERVAL_P(26, UART, NONE, NONE);
458 SERVAL_P(27, UART, NONE, NONE);
459 SERVAL_P(28, IRQ0, NONE, NONE);
460 SERVAL_P(29, IRQ1, NONE, NONE);
461 SERVAL_P(30, PTP0, NONE, NONE);
462 SERVAL_P(31, PTP0, NONE, NONE);
464 #define SERVAL_PIN(n) { \
467 .drv_data = &serval_pin_##n \
470 static const struct pinctrl_pin_desc serval_pins[] = {
505 #define OCELOT_P(p, f0, f1, f2) \
506 static struct ocelot_pin_caps ocelot_pin_##p = { \
509 FUNC_GPIO, FUNC_##f0, FUNC_##f1, FUNC_##f2, \
513 OCELOT_P(0, SG0, NONE, NONE);
514 OCELOT_P(1, SG0, NONE, NONE);
515 OCELOT_P(2, SG0, NONE, NONE);
516 OCELOT_P(3, SG0, NONE, NONE);
517 OCELOT_P(4, IRQ0_IN, IRQ0_OUT, TWI_SCL_M);
518 OCELOT_P(5, IRQ1_IN, IRQ1_OUT, PCI_WAKE);
519 OCELOT_P(6, UART, TWI_SCL_M, NONE);
520 OCELOT_P(7, UART, TWI_SCL_M, NONE);
521 OCELOT_P(8, SI, TWI_SCL_M, IRQ0_OUT);
522 OCELOT_P(9, SI, TWI_SCL_M, IRQ1_OUT);
523 OCELOT_P(10, PTP2, TWI_SCL_M, SFP);
524 OCELOT_P(11, PTP3, TWI_SCL_M, SFP);
525 OCELOT_P(12, UART2, TWI_SCL_M, SFP);
526 OCELOT_P(13, UART2, TWI_SCL_M, SFP);
527 OCELOT_P(14, MIIM, TWI_SCL_M, SFP);
528 OCELOT_P(15, MIIM, TWI_SCL_M, SFP);
529 OCELOT_P(16, TWI, NONE, SI);
530 OCELOT_P(17, TWI, TWI_SCL_M, SI);
531 OCELOT_P(18, PTP0, TWI_SCL_M, NONE);
532 OCELOT_P(19, PTP1, TWI_SCL_M, NONE);
533 OCELOT_P(20, RECO_CLK, TACHO, TWI_SCL_M);
534 OCELOT_P(21, RECO_CLK, PWM, TWI_SCL_M);
536 #define OCELOT_PIN(n) { \
539 .drv_data = &ocelot_pin_##n \
542 static const struct pinctrl_pin_desc ocelot_pins[] = {
567 #define JAGUAR2_P(p, f0, f1) \
568 static struct ocelot_pin_caps jaguar2_pin_##p = { \
571 FUNC_GPIO, FUNC_##f0, FUNC_##f1, FUNC_NONE \
575 JAGUAR2_P(0, SG0, NONE);
576 JAGUAR2_P(1, SG0, NONE);
577 JAGUAR2_P(2, SG0, NONE);
578 JAGUAR2_P(3, SG0, NONE);
579 JAGUAR2_P(4, SG1, NONE);
580 JAGUAR2_P(5, SG1, NONE);
581 JAGUAR2_P(6, IRQ0_IN, IRQ0_OUT);
582 JAGUAR2_P(7, IRQ1_IN, IRQ1_OUT);
583 JAGUAR2_P(8, PTP0, NONE);
584 JAGUAR2_P(9, PTP1, NONE);
585 JAGUAR2_P(10, UART, NONE);
586 JAGUAR2_P(11, UART, NONE);
587 JAGUAR2_P(12, SG1, NONE);
588 JAGUAR2_P(13, SG1, NONE);
589 JAGUAR2_P(14, TWI, TWI_SCL_M);
590 JAGUAR2_P(15, TWI, NONE);
591 JAGUAR2_P(16, SI, TWI_SCL_M);
592 JAGUAR2_P(17, SI, TWI_SCL_M);
593 JAGUAR2_P(18, SI, TWI_SCL_M);
594 JAGUAR2_P(19, PCI_WAKE, NONE);
595 JAGUAR2_P(20, IRQ0_OUT, TWI_SCL_M);
596 JAGUAR2_P(21, IRQ1_OUT, TWI_SCL_M);
597 JAGUAR2_P(22, TACHO, NONE);
598 JAGUAR2_P(23, PWM, NONE);
599 JAGUAR2_P(24, UART2, NONE);
600 JAGUAR2_P(25, UART2, SI);
601 JAGUAR2_P(26, PTP2, SI);
602 JAGUAR2_P(27, PTP3, SI);
603 JAGUAR2_P(28, TWI2, SI);
604 JAGUAR2_P(29, TWI2, SI);
605 JAGUAR2_P(30, SG2, SI);
606 JAGUAR2_P(31, SG2, SI);
607 JAGUAR2_P(32, SG2, SI);
608 JAGUAR2_P(33, SG2, SI);
609 JAGUAR2_P(34, NONE, TWI_SCL_M);
610 JAGUAR2_P(35, NONE, TWI_SCL_M);
611 JAGUAR2_P(36, NONE, TWI_SCL_M);
612 JAGUAR2_P(37, NONE, TWI_SCL_M);
613 JAGUAR2_P(38, NONE, TWI_SCL_M);
614 JAGUAR2_P(39, NONE, TWI_SCL_M);
615 JAGUAR2_P(40, NONE, TWI_SCL_M);
616 JAGUAR2_P(41, NONE, TWI_SCL_M);
617 JAGUAR2_P(42, NONE, TWI_SCL_M);
618 JAGUAR2_P(43, NONE, TWI_SCL_M);
619 JAGUAR2_P(44, NONE, SFP);
620 JAGUAR2_P(45, NONE, SFP);
621 JAGUAR2_P(46, NONE, SFP);
622 JAGUAR2_P(47, NONE, SFP);
623 JAGUAR2_P(48, SFP, NONE);
624 JAGUAR2_P(49, SFP, SI);
625 JAGUAR2_P(50, SFP, SI);
626 JAGUAR2_P(51, SFP, SI);
627 JAGUAR2_P(52, SFP, NONE);
628 JAGUAR2_P(53, SFP, NONE);
629 JAGUAR2_P(54, SFP, NONE);
630 JAGUAR2_P(55, SFP, NONE);
631 JAGUAR2_P(56, MIIM, SFP);
632 JAGUAR2_P(57, MIIM, SFP);
633 JAGUAR2_P(58, MIIM, SFP);
634 JAGUAR2_P(59, MIIM, SFP);
635 JAGUAR2_P(60, NONE, NONE);
636 JAGUAR2_P(61, NONE, NONE);
637 JAGUAR2_P(62, NONE, NONE);
638 JAGUAR2_P(63, NONE, NONE);
640 #define JAGUAR2_PIN(n) { \
643 .drv_data = &jaguar2_pin_##n \
646 static const struct pinctrl_pin_desc jaguar2_pins[] = {
713 #define SERVALT_P(p, f0, f1, f2) \
714 static struct ocelot_pin_caps servalt_pin_##p = { \
717 FUNC_GPIO, FUNC_##f0, FUNC_##f1, FUNC_##f2 \
721 SERVALT_P(0, SG0, NONE, NONE);
722 SERVALT_P(1, SG0, NONE, NONE);
723 SERVALT_P(2, SG0, NONE, NONE);
724 SERVALT_P(3, SG0, NONE, NONE);
725 SERVALT_P(4, IRQ0_IN, IRQ0_OUT, TWI_SCL_M);
726 SERVALT_P(5, IRQ1_IN, IRQ1_OUT, TWI_SCL_M);
727 SERVALT_P(6, UART, NONE, NONE);
728 SERVALT_P(7, UART, NONE, NONE);
729 SERVALT_P(8, SI, SFP, TWI_SCL_M);
730 SERVALT_P(9, PCI_WAKE, SFP, SI);
731 SERVALT_P(10, PTP0, SFP, TWI_SCL_M);
732 SERVALT_P(11, PTP1, SFP, TWI_SCL_M);
733 SERVALT_P(12, REF_CLK, SFP, TWI_SCL_M);
734 SERVALT_P(13, REF_CLK, SFP, TWI_SCL_M);
735 SERVALT_P(14, REF_CLK, IRQ0_OUT, SI);
736 SERVALT_P(15, REF_CLK, IRQ1_OUT, SI);
737 SERVALT_P(16, TACHO, SFP, SI);
738 SERVALT_P(17, PWM, NONE, TWI_SCL_M);
739 SERVALT_P(18, PTP2, SFP, SI);
740 SERVALT_P(19, PTP3, SFP, SI);
741 SERVALT_P(20, UART2, SFP, SI);
742 SERVALT_P(21, UART2, NONE, NONE);
743 SERVALT_P(22, MIIM, SFP, TWI2);
744 SERVALT_P(23, MIIM, SFP, TWI2);
745 SERVALT_P(24, TWI, NONE, NONE);
746 SERVALT_P(25, TWI, SFP, TWI_SCL_M);
747 SERVALT_P(26, TWI_SCL_M, SFP, SI);
748 SERVALT_P(27, TWI_SCL_M, SFP, SI);
749 SERVALT_P(28, TWI_SCL_M, SFP, SI);
750 SERVALT_P(29, TWI_SCL_M, NONE, NONE);
751 SERVALT_P(30, TWI_SCL_M, NONE, NONE);
752 SERVALT_P(31, TWI_SCL_M, NONE, NONE);
753 SERVALT_P(32, TWI_SCL_M, NONE, NONE);
754 SERVALT_P(33, RCVRD_CLK, NONE, NONE);
755 SERVALT_P(34, RCVRD_CLK, NONE, NONE);
756 SERVALT_P(35, RCVRD_CLK, NONE, NONE);
757 SERVALT_P(36, RCVRD_CLK, NONE, NONE);
759 #define SERVALT_PIN(n) { \
762 .drv_data = &servalt_pin_##n \
765 static const struct pinctrl_pin_desc servalt_pins[] = {
805 #define SPARX5_P(p, f0, f1, f2) \
806 static struct ocelot_pin_caps sparx5_pin_##p = { \
809 FUNC_GPIO, FUNC_##f0, FUNC_##f1, FUNC_##f2 \
813 SPARX5_P(0, SG0, PLL_STAT, NONE);
814 SPARX5_P(1, SG0, NONE, NONE);
815 SPARX5_P(2, SG0, NONE, NONE);
816 SPARX5_P(3, SG0, NONE, NONE);
817 SPARX5_P(4, SG1, NONE, NONE);
818 SPARX5_P(5, SG1, NONE, NONE);
819 SPARX5_P(6, IRQ0_IN, IRQ0_OUT, SFP);
820 SPARX5_P(7, IRQ1_IN, IRQ1_OUT, SFP);
821 SPARX5_P(8, PTP0, NONE, SFP);
822 SPARX5_P(9, PTP1, SFP, TWI_SCL_M);
823 SPARX5_P(10, UART, NONE, NONE);
824 SPARX5_P(11, UART, NONE, NONE);
825 SPARX5_P(12, SG1, NONE, NONE);
826 SPARX5_P(13, SG1, NONE, NONE);
827 SPARX5_P(14, TWI, TWI_SCL_M, NONE);
828 SPARX5_P(15, TWI, NONE, NONE);
829 SPARX5_P(16, SI, TWI_SCL_M, SFP);
830 SPARX5_P(17, SI, TWI_SCL_M, SFP);
831 SPARX5_P(18, SI, TWI_SCL_M, SFP);
832 SPARX5_P(19, PCI_WAKE, TWI_SCL_M, SFP);
833 SPARX5_P(20, IRQ0_OUT, TWI_SCL_M, SFP);
834 SPARX5_P(21, IRQ1_OUT, TACHO, SFP);
835 SPARX5_P(22, TACHO, IRQ0_OUT, TWI_SCL_M);
836 SPARX5_P(23, PWM, UART3, TWI_SCL_M);
837 SPARX5_P(24, PTP2, UART3, TWI_SCL_M);
838 SPARX5_P(25, PTP3, SI, TWI_SCL_M);
839 SPARX5_P(26, UART2, SI, TWI_SCL_M);
840 SPARX5_P(27, UART2, SI, TWI_SCL_M);
841 SPARX5_P(28, TWI2, SI, SFP);
842 SPARX5_P(29, TWI2, SI, SFP);
843 SPARX5_P(30, SG2, SI, PWM);
844 SPARX5_P(31, SG2, SI, TWI_SCL_M);
845 SPARX5_P(32, SG2, SI, TWI_SCL_M);
846 SPARX5_P(33, SG2, SI, SFP);
847 SPARX5_P(34, NONE, TWI_SCL_M, EMMC);
848 SPARX5_P(35, SFP, TWI_SCL_M, EMMC);
849 SPARX5_P(36, SFP, TWI_SCL_M, EMMC);
850 SPARX5_P(37, SFP, NONE, EMMC);
851 SPARX5_P(38, NONE, TWI_SCL_M, EMMC);
852 SPARX5_P(39, SI2, TWI_SCL_M, EMMC);
853 SPARX5_P(40, SI2, TWI_SCL_M, EMMC);
854 SPARX5_P(41, SI2, TWI_SCL_M, EMMC);
855 SPARX5_P(42, SI2, TWI_SCL_M, EMMC);
856 SPARX5_P(43, SI2, TWI_SCL_M, EMMC);
857 SPARX5_P(44, SI, SFP, EMMC);
858 SPARX5_P(45, SI, SFP, EMMC);
859 SPARX5_P(46, NONE, SFP, EMMC);
860 SPARX5_P(47, NONE, SFP, EMMC);
861 SPARX5_P(48, TWI3, SI, SFP);
862 SPARX5_P(49, TWI3, NONE, SFP);
863 SPARX5_P(50, SFP, NONE, TWI_SCL_M);
864 SPARX5_P(51, SFP, SI, TWI_SCL_M);
865 SPARX5_P(52, SFP, MIIM, TWI_SCL_M);
866 SPARX5_P(53, SFP, MIIM, TWI_SCL_M);
867 SPARX5_P(54, SFP, PTP2, TWI_SCL_M);
868 SPARX5_P(55, SFP, PTP3, PCI_WAKE);
869 SPARX5_P(56, MIIM, SFP, TWI_SCL_M);
870 SPARX5_P(57, MIIM, SFP, TWI_SCL_M);
871 SPARX5_P(58, MIIM, SFP, TWI_SCL_M);
872 SPARX5_P(59, MIIM, SFP, NONE);
873 SPARX5_P(60, RECO_CLK, NONE, NONE);
874 SPARX5_P(61, RECO_CLK, NONE, NONE);
875 SPARX5_P(62, RECO_CLK, PLL_STAT, NONE);
876 SPARX5_P(63, RECO_CLK, NONE, NONE);
878 #define SPARX5_PIN(n) { \
881 .drv_data = &sparx5_pin_##n \
884 static const struct pinctrl_pin_desc sparx5_pins[] = {
951 #define LAN966X_P(p, f0, f1, f2, f3, f4, f5, f6, f7) \
952 static struct ocelot_pin_caps lan966x_pin_##p = { \
955 FUNC_##f0, FUNC_##f1, FUNC_##f2, \
959 FUNC_##f4, FUNC_##f5, FUNC_##f6, \
964 /* Pinmuxing table taken from data sheet */
965 /* Pin FUNC0 FUNC1 FUNC2 FUNC3 FUNC4 FUNC5 FUNC6 FUNC7 */
966 LAN966X_P(0, GPIO, NONE, NONE, NONE, NONE, NONE, NONE, R);
967 LAN966X_P(1, GPIO, NONE, NONE, NONE, NONE, NONE, NONE, R);
968 LAN966X_P(2, GPIO, NONE, NONE, NONE, NONE, NONE, NONE, R);
969 LAN966X_P(3, GPIO, NONE, NONE, NONE, NONE, NONE, NONE, R);
970 LAN966X_P(4, GPIO, NONE, NONE, NONE, NONE, NONE, NONE, R);
971 LAN966X_P(5, GPIO, NONE, NONE, NONE, NONE, NONE, NONE, R);
972 LAN966X_P(6, GPIO, NONE, NONE, NONE, NONE, NONE, NONE, R);
973 LAN966X_P(7, GPIO, NONE, NONE, NONE, NONE, NONE, NONE, R);
974 LAN966X_P(8, GPIO, FC0_a, USB_H_b, NONE, USB_S_b, NONE, NONE, R);
975 LAN966X_P(9, GPIO, FC0_a, USB_H_b, NONE, NONE, NONE, NONE, R);
976 LAN966X_P(10, GPIO, FC0_a, NONE, NONE, NONE, NONE, NONE, R);
977 LAN966X_P(11, GPIO, FC1_a, NONE, NONE, NONE, NONE, NONE, R);
978 LAN966X_P(12, GPIO, FC1_a, NONE, NONE, NONE, NONE, NONE, R);
979 LAN966X_P(13, GPIO, FC1_a, NONE, NONE, NONE, NONE, NONE, R);
980 LAN966X_P(14, GPIO, FC2_a, NONE, NONE, NONE, NONE, NONE, R);
981 LAN966X_P(15, GPIO, FC2_a, NONE, NONE, NONE, NONE, NONE, R);
982 LAN966X_P(16, GPIO, FC2_a, IB_TRG_a, NONE, OB_TRG_a, IRQ_IN_c, IRQ_OUT_c, R);
983 LAN966X_P(17, GPIO, FC3_a, IB_TRG_a, NONE, OB_TRG_a, IRQ_IN_c, IRQ_OUT_c, R);
984 LAN966X_P(18, GPIO, FC3_a, IB_TRG_a, NONE, OB_TRG_a, IRQ_IN_c, IRQ_OUT_c, R);
985 LAN966X_P(19, GPIO, FC3_a, IB_TRG_a, NONE, OB_TRG_a, IRQ_IN_c, IRQ_OUT_c, R);
986 LAN966X_P(20, GPIO, FC4_a, IB_TRG_a, NONE, OB_TRG_a, IRQ_IN_c, NONE, R);
987 LAN966X_P(21, GPIO, FC4_a, NONE, NONE, OB_TRG_a, NONE, NONE, R);
988 LAN966X_P(22, GPIO, FC4_a, NONE, NONE, OB_TRG_a, NONE, NONE, R);
989 LAN966X_P(23, GPIO, NONE, NONE, NONE, OB_TRG_a, NONE, NONE, R);
990 LAN966X_P(24, GPIO, FC0_b, IB_TRG_a, USB_H_c, OB_TRG_a, IRQ_IN_c, TACHO_a, R);
991 LAN966X_P(25, GPIO, FC0_b, IB_TRG_a, USB_H_c, OB_TRG_a, IRQ_OUT_c, SFP_SD, R);
992 LAN966X_P(26, GPIO, FC0_b, IB_TRG_a, USB_S_c, OB_TRG_a, CAN0_a, SFP_SD, R);
993 LAN966X_P(27, GPIO, NONE, NONE, NONE, OB_TRG_a, CAN0_a, PWM_a, R);
994 LAN966X_P(28, GPIO, MIIM_a, NONE, NONE, OB_TRG_a, IRQ_OUT_c, SFP_SD, R);
995 LAN966X_P(29, GPIO, MIIM_a, NONE, NONE, OB_TRG_a, NONE, NONE, R);
996 LAN966X_P(30, GPIO, FC3_c, CAN1, CLKMON, OB_TRG, RECO_b, NONE, R);
997 LAN966X_P(31, GPIO, FC3_c, CAN1, CLKMON, OB_TRG, RECO_b, NONE, R);
998 LAN966X_P(32, GPIO, FC3_c, NONE, SGPIO_a, NONE, MIIM_Sa, NONE, R);
999 LAN966X_P(33, GPIO, FC1_b, NONE, SGPIO_a, NONE, MIIM_Sa, MIIM_b, R);
1000 LAN966X_P(34, GPIO, FC1_b, NONE, SGPIO_a, NONE, MIIM_Sa, MIIM_b, R);
1001 LAN966X_P(35, GPIO, FC1_b, PTPSYNC_0, SGPIO_a, CAN0_b, NONE, NONE, R);
1002 LAN966X_P(36, GPIO, NONE, PTPSYNC_1, NONE, CAN0_b, NONE, NONE, R);
1003 LAN966X_P(37, GPIO, FC_SHRD0, PTPSYNC_2, TWI_SLC_GATE_AD, NONE, NONE, NONE, R);
1004 LAN966X_P(38, GPIO, NONE, PTPSYNC_3, NONE, NONE, NONE, NONE, R);
1005 LAN966X_P(39, GPIO, NONE, PTPSYNC_4, NONE, NONE, NONE, NONE, R);
1006 LAN966X_P(40, GPIO, FC_SHRD1, PTPSYNC_5, NONE, NONE, NONE, NONE, R);
1007 LAN966X_P(41, GPIO, FC_SHRD2, PTPSYNC_6, TWI_SLC_GATE_AD, NONE, NONE, NONE, R);
1008 LAN966X_P(42, GPIO, FC_SHRD3, PTPSYNC_7, TWI_SLC_GATE_AD, NONE, NONE, NONE, R);
1009 LAN966X_P(43, GPIO, FC2_b, OB_TRG_b, IB_TRG_b, IRQ_OUT_a, RECO_a, IRQ_IN_a, R);
1010 LAN966X_P(44, GPIO, FC2_b, OB_TRG_b, IB_TRG_b, IRQ_OUT_a, RECO_a, IRQ_IN_a, R);
1011 LAN966X_P(45, GPIO, FC2_b, OB_TRG_b, IB_TRG_b, IRQ_OUT_a, NONE, IRQ_IN_a, R);
1012 LAN966X_P(46, GPIO, FC1_c, OB_TRG_b, IB_TRG_b, IRQ_OUT_a, FC_SHRD4, IRQ_IN_a, R);
1013 LAN966X_P(47, GPIO, FC1_c, OB_TRG_b, IB_TRG_b, IRQ_OUT_a, FC_SHRD5, IRQ_IN_a, R);
1014 LAN966X_P(48, GPIO, FC1_c, OB_TRG_b, IB_TRG_b, IRQ_OUT_a, FC_SHRD6, IRQ_IN_a, R);
1015 LAN966X_P(49, GPIO, FC_SHRD7, OB_TRG_b, IB_TRG_b, IRQ_OUT_a, TWI_SLC_GATE, IRQ_IN_a, R);
1016 LAN966X_P(50, GPIO, FC_SHRD16, OB_TRG_b, IB_TRG_b, IRQ_OUT_a, TWI_SLC_GATE, NONE, R);
1017 LAN966X_P(51, GPIO, FC3_b, OB_TRG_b, IB_TRG_c, IRQ_OUT_b, PWM_b, IRQ_IN_b, R);
1018 LAN966X_P(52, GPIO, FC3_b, OB_TRG_b, IB_TRG_c, IRQ_OUT_b, TACHO_b, IRQ_IN_b, R);
1019 LAN966X_P(53, GPIO, FC3_b, OB_TRG_b, IB_TRG_c, IRQ_OUT_b, NONE, IRQ_IN_b, R);
1020 LAN966X_P(54, GPIO, FC_SHRD8, OB_TRG_b, IB_TRG_c, IRQ_OUT_b, TWI_SLC_GATE, IRQ_IN_b, R);
1021 LAN966X_P(55, GPIO, FC_SHRD9, OB_TRG_b, IB_TRG_c, IRQ_OUT_b, TWI_SLC_GATE, IRQ_IN_b, R);
1022 LAN966X_P(56, GPIO, FC4_b, OB_TRG_b, IB_TRG_c, IRQ_OUT_b, FC_SHRD10, IRQ_IN_b, R);
1023 LAN966X_P(57, GPIO, FC4_b, TWI_SLC_GATE, IB_TRG_c, IRQ_OUT_b, FC_SHRD11, IRQ_IN_b, R);
1024 LAN966X_P(58, GPIO, FC4_b, TWI_SLC_GATE, IB_TRG_c, IRQ_OUT_b, FC_SHRD12, IRQ_IN_b, R);
1025 LAN966X_P(59, GPIO, QSPI1, MIIM_c, NONE, NONE, MIIM_Sb, NONE, R);
1026 LAN966X_P(60, GPIO, QSPI1, MIIM_c, NONE, NONE, MIIM_Sb, NONE, R);
1027 LAN966X_P(61, GPIO, QSPI1, NONE, SGPIO_b, FC0_c, MIIM_Sb, NONE, R);
1028 LAN966X_P(62, GPIO, QSPI1, FC_SHRD13, SGPIO_b, FC0_c, TWI_SLC_GATE, SFP_SD, R);
1029 LAN966X_P(63, GPIO, QSPI1, FC_SHRD14, SGPIO_b, FC0_c, TWI_SLC_GATE, SFP_SD, R);
1030 LAN966X_P(64, GPIO, QSPI1, FC4_c, SGPIO_b, FC_SHRD15, TWI_SLC_GATE, SFP_SD, R);
1031 LAN966X_P(65, GPIO, USB_H_a, FC4_c, NONE, IRQ_OUT_c, TWI_SLC_GATE_AD, NONE, R);
1032 LAN966X_P(66, GPIO, USB_H_a, FC4_c, USB_S_a, IRQ_OUT_c, IRQ_IN_c, NONE, R);
1033 LAN966X_P(67, GPIO, EMMC_SD, NONE, QSPI2, NONE, NONE, NONE, R);
1034 LAN966X_P(68, GPIO, EMMC_SD, NONE, QSPI2, NONE, NONE, NONE, R);
1035 LAN966X_P(69, GPIO, EMMC_SD, NONE, QSPI2, NONE, NONE, NONE, R);
1036 LAN966X_P(70, GPIO, EMMC_SD, NONE, QSPI2, NONE, NONE, NONE, R);
1037 LAN966X_P(71, GPIO, EMMC_SD, NONE, QSPI2, NONE, NONE, NONE, R);
1038 LAN966X_P(72, GPIO, EMMC_SD, NONE, QSPI2, NONE, NONE, NONE, R);
1039 LAN966X_P(73, GPIO, EMMC, NONE, NONE, SD, NONE, NONE, R);
1040 LAN966X_P(74, GPIO, EMMC, NONE, FC_SHRD17, SD, TWI_SLC_GATE, NONE, R);
1041 LAN966X_P(75, GPIO, EMMC, NONE, FC_SHRD18, SD, TWI_SLC_GATE, NONE, R);
1042 LAN966X_P(76, GPIO, EMMC, NONE, FC_SHRD19, SD, TWI_SLC_GATE, NONE, R);
1043 LAN966X_P(77, GPIO, EMMC_SD, NONE, FC_SHRD20, NONE, TWI_SLC_GATE, NONE, R);
1045 #define LAN966X_PIN(n) { \
1047 .name = "GPIO_"#n, \
1048 .drv_data = &lan966x_pin_##n \
1051 static const struct pinctrl_pin_desc lan966x_pins[] = {
1132 static int ocelot_get_functions_count(struct pinctrl_dev *pctldev)
1134 return ARRAY_SIZE(ocelot_function_names);
1137 static const char *ocelot_get_function_name(struct pinctrl_dev *pctldev,
1138 unsigned int function)
1140 return ocelot_function_names[function];
1143 static int ocelot_get_function_groups(struct pinctrl_dev *pctldev,
1144 unsigned int function,
1145 const char *const **groups,
1146 unsigned *const num_groups)
1148 struct ocelot_pinctrl *info = pinctrl_dev_get_drvdata(pctldev);
1150 *groups = info->func[function].groups;
1151 *num_groups = info->func[function].ngroups;
1156 static int ocelot_pin_function_idx(struct ocelot_pinctrl *info,
1157 unsigned int pin, unsigned int function)
1159 struct ocelot_pin_caps *p = info->desc->pins[pin].drv_data;
1162 for (i = 0; i < OCELOT_FUNC_PER_PIN; i++) {
1163 if (function == p->functions[i])
1166 if (function == p->a_functions[i])
1167 return i + OCELOT_FUNC_PER_PIN;
1173 #define REG_ALT(msb, info, p) (OCELOT_GPIO_ALT0 * (info)->stride + 4 * ((msb) + ((info)->stride * ((p) / 32))))
1175 static int ocelot_pinmux_set_mux(struct pinctrl_dev *pctldev,
1176 unsigned int selector, unsigned int group)
1178 struct ocelot_pinctrl *info = pinctrl_dev_get_drvdata(pctldev);
1179 struct ocelot_pin_caps *pin = info->desc->pins[group].drv_data;
1180 unsigned int p = pin->pin % 32;
1183 f = ocelot_pin_function_idx(info, group, selector);
1188 * f is encoded on two bits.
1189 * bit 0 of f goes in BIT(pin) of ALT[0], bit 1 of f goes in BIT(pin) of
1191 * This is racy because both registers can't be updated at the same time
1192 * but it doesn't matter much for now.
1193 * Note: ALT0/ALT1 are organized specially for 64 gpio targets
1195 regmap_update_bits(info->map, REG_ALT(0, info, pin->pin),
1197 regmap_update_bits(info->map, REG_ALT(1, info, pin->pin),
1198 BIT(p), f << (p - 1));
1203 static int lan966x_pinmux_set_mux(struct pinctrl_dev *pctldev,
1204 unsigned int selector, unsigned int group)
1206 struct ocelot_pinctrl *info = pinctrl_dev_get_drvdata(pctldev);
1207 struct ocelot_pin_caps *pin = info->desc->pins[group].drv_data;
1208 unsigned int p = pin->pin % 32;
1211 f = ocelot_pin_function_idx(info, group, selector);
1216 * f is encoded on three bits.
1217 * bit 0 of f goes in BIT(pin) of ALT[0], bit 1 of f goes in BIT(pin) of
1218 * ALT[1], bit 2 of f goes in BIT(pin) of ALT[2]
1219 * This is racy because three registers can't be updated at the same time
1220 * but it doesn't matter much for now.
1221 * Note: ALT0/ALT1/ALT2 are organized specially for 78 gpio targets
1223 regmap_update_bits(info->map, REG_ALT(0, info, pin->pin),
1225 regmap_update_bits(info->map, REG_ALT(1, info, pin->pin),
1226 BIT(p), (f >> 1) << p);
1227 regmap_update_bits(info->map, REG_ALT(2, info, pin->pin),
1228 BIT(p), (f >> 2) << p);
1233 #define REG(r, info, p) ((r) * (info)->stride + (4 * ((p) / 32)))
1235 static int ocelot_gpio_set_direction(struct pinctrl_dev *pctldev,
1236 struct pinctrl_gpio_range *range,
1237 unsigned int pin, bool input)
1239 struct ocelot_pinctrl *info = pinctrl_dev_get_drvdata(pctldev);
1240 unsigned int p = pin % 32;
1242 regmap_update_bits(info->map, REG(OCELOT_GPIO_OE, info, pin), BIT(p),
1243 input ? 0 : BIT(p));
1248 static int ocelot_gpio_request_enable(struct pinctrl_dev *pctldev,
1249 struct pinctrl_gpio_range *range,
1250 unsigned int offset)
1252 struct ocelot_pinctrl *info = pinctrl_dev_get_drvdata(pctldev);
1253 unsigned int p = offset % 32;
1255 regmap_update_bits(info->map, REG_ALT(0, info, offset),
1257 regmap_update_bits(info->map, REG_ALT(1, info, offset),
1263 static int lan966x_gpio_request_enable(struct pinctrl_dev *pctldev,
1264 struct pinctrl_gpio_range *range,
1265 unsigned int offset)
1267 struct ocelot_pinctrl *info = pinctrl_dev_get_drvdata(pctldev);
1268 unsigned int p = offset % 32;
1270 regmap_update_bits(info->map, REG_ALT(0, info, offset),
1272 regmap_update_bits(info->map, REG_ALT(1, info, offset),
1274 regmap_update_bits(info->map, REG_ALT(2, info, offset),
1280 static const struct pinmux_ops ocelot_pmx_ops = {
1281 .get_functions_count = ocelot_get_functions_count,
1282 .get_function_name = ocelot_get_function_name,
1283 .get_function_groups = ocelot_get_function_groups,
1284 .set_mux = ocelot_pinmux_set_mux,
1285 .gpio_set_direction = ocelot_gpio_set_direction,
1286 .gpio_request_enable = ocelot_gpio_request_enable,
1289 static const struct pinmux_ops lan966x_pmx_ops = {
1290 .get_functions_count = ocelot_get_functions_count,
1291 .get_function_name = ocelot_get_function_name,
1292 .get_function_groups = ocelot_get_function_groups,
1293 .set_mux = lan966x_pinmux_set_mux,
1294 .gpio_set_direction = ocelot_gpio_set_direction,
1295 .gpio_request_enable = lan966x_gpio_request_enable,
1298 static int ocelot_pctl_get_groups_count(struct pinctrl_dev *pctldev)
1300 struct ocelot_pinctrl *info = pinctrl_dev_get_drvdata(pctldev);
1302 return info->desc->npins;
1305 static const char *ocelot_pctl_get_group_name(struct pinctrl_dev *pctldev,
1308 struct ocelot_pinctrl *info = pinctrl_dev_get_drvdata(pctldev);
1310 return info->desc->pins[group].name;
1313 static int ocelot_pctl_get_group_pins(struct pinctrl_dev *pctldev,
1315 const unsigned int **pins,
1316 unsigned int *num_pins)
1318 struct ocelot_pinctrl *info = pinctrl_dev_get_drvdata(pctldev);
1320 *pins = &info->desc->pins[group].number;
1326 static int ocelot_hw_get_value(struct ocelot_pinctrl *info,
1331 int ret = -EOPNOTSUPP;
1334 const struct ocelot_pincfg_data *opd = info->pincfg_data;
1337 ret = regmap_read(info->pincfg,
1338 pin * regmap_get_reg_stride(info->pincfg),
1346 *val = regcfg & (opd->pd_bit | opd->pu_bit);
1349 case PINCONF_SCHMITT:
1350 *val = regcfg & opd->schmitt_bit;
1353 case PINCONF_DRIVE_STRENGTH:
1354 *val = regcfg & opd->drive_bits;
1365 static int ocelot_pincfg_clrsetbits(struct ocelot_pinctrl *info, u32 regaddr,
1366 u32 clrbits, u32 setbits)
1371 ret = regmap_read(info->pincfg,
1372 regaddr * regmap_get_reg_stride(info->pincfg),
1380 ret = regmap_write(info->pincfg,
1381 regaddr * regmap_get_reg_stride(info->pincfg),
1387 static int ocelot_hw_set_value(struct ocelot_pinctrl *info,
1392 int ret = -EOPNOTSUPP;
1395 const struct ocelot_pincfg_data *opd = info->pincfg_data;
1400 ret = ocelot_pincfg_clrsetbits(info, pin,
1401 opd->pd_bit | opd->pu_bit,
1405 case PINCONF_SCHMITT:
1406 ret = ocelot_pincfg_clrsetbits(info, pin,
1411 case PINCONF_DRIVE_STRENGTH:
1413 ret = ocelot_pincfg_clrsetbits(info, pin,
1428 static int ocelot_pinconf_get(struct pinctrl_dev *pctldev,
1429 unsigned int pin, unsigned long *config)
1431 struct ocelot_pinctrl *info = pinctrl_dev_get_drvdata(pctldev);
1432 u32 param = pinconf_to_config_param(*config);
1436 case PIN_CONFIG_BIAS_DISABLE:
1437 case PIN_CONFIG_BIAS_PULL_UP:
1438 case PIN_CONFIG_BIAS_PULL_DOWN:
1439 err = ocelot_hw_get_value(info, pin, PINCONF_BIAS, &val);
1442 if (param == PIN_CONFIG_BIAS_DISABLE)
1444 else if (param == PIN_CONFIG_BIAS_PULL_DOWN)
1445 val = !!(val & info->pincfg_data->pd_bit);
1446 else /* PIN_CONFIG_BIAS_PULL_UP */
1447 val = !!(val & info->pincfg_data->pu_bit);
1450 case PIN_CONFIG_INPUT_SCHMITT_ENABLE:
1451 if (!info->pincfg_data->schmitt_bit)
1454 err = ocelot_hw_get_value(info, pin, PINCONF_SCHMITT, &val);
1458 val = !!(val & info->pincfg_data->schmitt_bit);
1461 case PIN_CONFIG_DRIVE_STRENGTH:
1462 err = ocelot_hw_get_value(info, pin, PINCONF_DRIVE_STRENGTH,
1468 case PIN_CONFIG_OUTPUT:
1469 err = regmap_read(info->map, REG(OCELOT_GPIO_OUT, info, pin),
1473 val = !!(val & BIT(pin % 32));
1476 case PIN_CONFIG_INPUT_ENABLE:
1477 case PIN_CONFIG_OUTPUT_ENABLE:
1478 err = regmap_read(info->map, REG(OCELOT_GPIO_OE, info, pin),
1482 val = val & BIT(pin % 32);
1483 if (param == PIN_CONFIG_OUTPUT_ENABLE)
1493 *config = pinconf_to_config_packed(param, val);
1498 static int ocelot_pinconf_set(struct pinctrl_dev *pctldev, unsigned int pin,
1499 unsigned long *configs, unsigned int num_configs)
1501 struct ocelot_pinctrl *info = pinctrl_dev_get_drvdata(pctldev);
1502 const struct ocelot_pincfg_data *opd = info->pincfg_data;
1506 for (cfg = 0; cfg < num_configs; cfg++) {
1507 param = pinconf_to_config_param(configs[cfg]);
1508 arg = pinconf_to_config_argument(configs[cfg]);
1511 case PIN_CONFIG_BIAS_DISABLE:
1512 case PIN_CONFIG_BIAS_PULL_UP:
1513 case PIN_CONFIG_BIAS_PULL_DOWN:
1514 arg = (param == PIN_CONFIG_BIAS_DISABLE) ? 0 :
1515 (param == PIN_CONFIG_BIAS_PULL_UP) ?
1516 opd->pu_bit : opd->pd_bit;
1518 err = ocelot_hw_set_value(info, pin, PINCONF_BIAS, arg);
1524 case PIN_CONFIG_INPUT_SCHMITT_ENABLE:
1525 if (!opd->schmitt_bit)
1528 arg = arg ? opd->schmitt_bit : 0;
1529 err = ocelot_hw_set_value(info, pin, PINCONF_SCHMITT,
1536 case PIN_CONFIG_DRIVE_STRENGTH:
1537 err = ocelot_hw_set_value(info, pin,
1538 PINCONF_DRIVE_STRENGTH,
1545 case PIN_CONFIG_OUTPUT_ENABLE:
1546 case PIN_CONFIG_INPUT_ENABLE:
1547 case PIN_CONFIG_OUTPUT:
1550 regmap_write(info->map,
1551 REG(OCELOT_GPIO_OUT_SET, info,
1555 regmap_write(info->map,
1556 REG(OCELOT_GPIO_OUT_CLR, info,
1559 regmap_update_bits(info->map,
1560 REG(OCELOT_GPIO_OE, info, pin),
1562 param == PIN_CONFIG_INPUT_ENABLE ?
1574 static const struct pinconf_ops ocelot_confops = {
1576 .pin_config_get = ocelot_pinconf_get,
1577 .pin_config_set = ocelot_pinconf_set,
1578 .pin_config_config_dbg_show = pinconf_generic_dump_config,
1581 static const struct pinctrl_ops ocelot_pctl_ops = {
1582 .get_groups_count = ocelot_pctl_get_groups_count,
1583 .get_group_name = ocelot_pctl_get_group_name,
1584 .get_group_pins = ocelot_pctl_get_group_pins,
1585 .dt_node_to_map = pinconf_generic_dt_node_to_map_pin,
1586 .dt_free_map = pinconf_generic_dt_free_map,
1589 static struct ocelot_match_data luton_desc = {
1591 .name = "luton-pinctrl",
1593 .npins = ARRAY_SIZE(luton_pins),
1594 .pctlops = &ocelot_pctl_ops,
1595 .pmxops = &ocelot_pmx_ops,
1596 .owner = THIS_MODULE,
1600 static struct ocelot_match_data serval_desc = {
1602 .name = "serval-pinctrl",
1603 .pins = serval_pins,
1604 .npins = ARRAY_SIZE(serval_pins),
1605 .pctlops = &ocelot_pctl_ops,
1606 .pmxops = &ocelot_pmx_ops,
1607 .owner = THIS_MODULE,
1611 static struct ocelot_match_data ocelot_desc = {
1613 .name = "ocelot-pinctrl",
1614 .pins = ocelot_pins,
1615 .npins = ARRAY_SIZE(ocelot_pins),
1616 .pctlops = &ocelot_pctl_ops,
1617 .pmxops = &ocelot_pmx_ops,
1618 .owner = THIS_MODULE,
1622 static struct ocelot_match_data jaguar2_desc = {
1624 .name = "jaguar2-pinctrl",
1625 .pins = jaguar2_pins,
1626 .npins = ARRAY_SIZE(jaguar2_pins),
1627 .pctlops = &ocelot_pctl_ops,
1628 .pmxops = &ocelot_pmx_ops,
1629 .owner = THIS_MODULE,
1633 static struct ocelot_match_data servalt_desc = {
1635 .name = "servalt-pinctrl",
1636 .pins = servalt_pins,
1637 .npins = ARRAY_SIZE(servalt_pins),
1638 .pctlops = &ocelot_pctl_ops,
1639 .pmxops = &ocelot_pmx_ops,
1640 .owner = THIS_MODULE,
1644 static struct ocelot_match_data sparx5_desc = {
1646 .name = "sparx5-pinctrl",
1647 .pins = sparx5_pins,
1648 .npins = ARRAY_SIZE(sparx5_pins),
1649 .pctlops = &ocelot_pctl_ops,
1650 .pmxops = &ocelot_pmx_ops,
1651 .confops = &ocelot_confops,
1652 .owner = THIS_MODULE,
1657 .drive_bits = GENMASK(1, 0),
1658 .schmitt_bit = BIT(2),
1662 static struct ocelot_match_data lan966x_desc = {
1664 .name = "lan966x-pinctrl",
1665 .pins = lan966x_pins,
1666 .npins = ARRAY_SIZE(lan966x_pins),
1667 .pctlops = &ocelot_pctl_ops,
1668 .pmxops = &lan966x_pmx_ops,
1669 .confops = &ocelot_confops,
1670 .owner = THIS_MODULE,
1675 .drive_bits = GENMASK(1, 0),
1679 static int ocelot_create_group_func_map(struct device *dev,
1680 struct ocelot_pinctrl *info)
1683 u8 *pins = kcalloc(info->desc->npins, sizeof(u8), GFP_KERNEL);
1688 for (f = 0; f < FUNC_MAX; f++) {
1689 for (npins = 0, i = 0; i < info->desc->npins; i++) {
1690 if (ocelot_pin_function_idx(info, i, f) >= 0)
1697 info->func[f].ngroups = npins;
1698 info->func[f].groups = devm_kcalloc(dev, npins, sizeof(char *),
1700 if (!info->func[f].groups) {
1705 for (i = 0; i < npins; i++)
1706 info->func[f].groups[i] =
1707 info->desc->pins[pins[i]].name;
1715 static int ocelot_pinctrl_register(struct platform_device *pdev,
1716 struct ocelot_pinctrl *info)
1720 ret = ocelot_create_group_func_map(&pdev->dev, info);
1722 dev_err(&pdev->dev, "Unable to create group func map.\n");
1726 info->pctl = devm_pinctrl_register(&pdev->dev, info->desc, info);
1727 if (IS_ERR(info->pctl)) {
1728 dev_err(&pdev->dev, "Failed to register pinctrl\n");
1729 return PTR_ERR(info->pctl);
1735 static int ocelot_gpio_get(struct gpio_chip *chip, unsigned int offset)
1737 struct ocelot_pinctrl *info = gpiochip_get_data(chip);
1740 regmap_read(info->map, REG(OCELOT_GPIO_IN, info, offset), &val);
1742 return !!(val & BIT(offset % 32));
1745 static void ocelot_gpio_set(struct gpio_chip *chip, unsigned int offset,
1748 struct ocelot_pinctrl *info = gpiochip_get_data(chip);
1751 regmap_write(info->map, REG(OCELOT_GPIO_OUT_SET, info, offset),
1754 regmap_write(info->map, REG(OCELOT_GPIO_OUT_CLR, info, offset),
1758 static int ocelot_gpio_get_direction(struct gpio_chip *chip,
1759 unsigned int offset)
1761 struct ocelot_pinctrl *info = gpiochip_get_data(chip);
1764 regmap_read(info->map, REG(OCELOT_GPIO_OE, info, offset), &val);
1766 if (val & BIT(offset % 32))
1767 return GPIO_LINE_DIRECTION_OUT;
1769 return GPIO_LINE_DIRECTION_IN;
1772 static int ocelot_gpio_direction_input(struct gpio_chip *chip,
1773 unsigned int offset)
1775 return pinctrl_gpio_direction_input(chip->base + offset);
1778 static int ocelot_gpio_direction_output(struct gpio_chip *chip,
1779 unsigned int offset, int value)
1781 struct ocelot_pinctrl *info = gpiochip_get_data(chip);
1782 unsigned int pin = BIT(offset % 32);
1785 regmap_write(info->map, REG(OCELOT_GPIO_OUT_SET, info, offset),
1788 regmap_write(info->map, REG(OCELOT_GPIO_OUT_CLR, info, offset),
1791 return pinctrl_gpio_direction_output(chip->base + offset);
1794 static const struct gpio_chip ocelot_gpiolib_chip = {
1795 .request = gpiochip_generic_request,
1796 .free = gpiochip_generic_free,
1797 .set = ocelot_gpio_set,
1798 .get = ocelot_gpio_get,
1799 .get_direction = ocelot_gpio_get_direction,
1800 .direction_input = ocelot_gpio_direction_input,
1801 .direction_output = ocelot_gpio_direction_output,
1802 .owner = THIS_MODULE,
1805 static void ocelot_irq_mask(struct irq_data *data)
1807 struct gpio_chip *chip = irq_data_get_irq_chip_data(data);
1808 struct ocelot_pinctrl *info = gpiochip_get_data(chip);
1809 unsigned int gpio = irqd_to_hwirq(data);
1811 regmap_update_bits(info->map, REG(OCELOT_GPIO_INTR_ENA, info, gpio),
1815 static void ocelot_irq_unmask(struct irq_data *data)
1817 struct gpio_chip *chip = irq_data_get_irq_chip_data(data);
1818 struct ocelot_pinctrl *info = gpiochip_get_data(chip);
1819 unsigned int gpio = irqd_to_hwirq(data);
1821 regmap_update_bits(info->map, REG(OCELOT_GPIO_INTR_ENA, info, gpio),
1822 BIT(gpio % 32), BIT(gpio % 32));
1825 static void ocelot_irq_ack(struct irq_data *data)
1827 struct gpio_chip *chip = irq_data_get_irq_chip_data(data);
1828 struct ocelot_pinctrl *info = gpiochip_get_data(chip);
1829 unsigned int gpio = irqd_to_hwirq(data);
1831 regmap_write_bits(info->map, REG(OCELOT_GPIO_INTR, info, gpio),
1832 BIT(gpio % 32), BIT(gpio % 32));
1835 static int ocelot_irq_set_type(struct irq_data *data, unsigned int type);
1837 static struct irq_chip ocelot_eoi_irqchip = {
1839 .irq_mask = ocelot_irq_mask,
1840 .irq_eoi = ocelot_irq_ack,
1841 .irq_unmask = ocelot_irq_unmask,
1842 .flags = IRQCHIP_EOI_THREADED | IRQCHIP_EOI_IF_HANDLED,
1843 .irq_set_type = ocelot_irq_set_type,
1846 static struct irq_chip ocelot_irqchip = {
1848 .irq_mask = ocelot_irq_mask,
1849 .irq_ack = ocelot_irq_ack,
1850 .irq_unmask = ocelot_irq_unmask,
1851 .irq_set_type = ocelot_irq_set_type,
1854 static int ocelot_irq_set_type(struct irq_data *data, unsigned int type)
1856 type &= IRQ_TYPE_SENSE_MASK;
1858 if (!(type & (IRQ_TYPE_EDGE_BOTH | IRQ_TYPE_LEVEL_HIGH)))
1861 if (type & IRQ_TYPE_LEVEL_HIGH)
1862 irq_set_chip_handler_name_locked(data, &ocelot_eoi_irqchip,
1863 handle_fasteoi_irq, NULL);
1864 if (type & IRQ_TYPE_EDGE_BOTH)
1865 irq_set_chip_handler_name_locked(data, &ocelot_irqchip,
1866 handle_edge_irq, NULL);
1871 static void ocelot_irq_handler(struct irq_desc *desc)
1873 struct irq_chip *parent_chip = irq_desc_get_chip(desc);
1874 struct gpio_chip *chip = irq_desc_get_handler_data(desc);
1875 struct ocelot_pinctrl *info = gpiochip_get_data(chip);
1876 unsigned int id_reg = OCELOT_GPIO_INTR_IDENT * info->stride;
1877 unsigned int reg = 0, irq, i;
1880 for (i = 0; i < info->stride; i++) {
1881 regmap_read(info->map, id_reg + 4 * i, ®);
1885 chained_irq_enter(parent_chip, desc);
1889 for_each_set_bit(irq, &irqs,
1890 min(32U, info->desc->npins - 32 * i))
1891 generic_handle_domain_irq(chip->irq.domain, irq + 32 * i);
1893 chained_irq_exit(parent_chip, desc);
1897 static int ocelot_gpiochip_register(struct platform_device *pdev,
1898 struct ocelot_pinctrl *info)
1900 struct gpio_chip *gc;
1901 struct gpio_irq_chip *girq;
1904 info->gpio_chip = ocelot_gpiolib_chip;
1906 gc = &info->gpio_chip;
1907 gc->ngpio = info->desc->npins;
1908 gc->parent = &pdev->dev;
1910 gc->label = "ocelot-gpio";
1912 irq = platform_get_irq_optional(pdev, 0);
1915 girq->chip = &ocelot_irqchip;
1916 girq->parent_handler = ocelot_irq_handler;
1917 girq->num_parents = 1;
1918 girq->parents = devm_kcalloc(&pdev->dev, 1,
1919 sizeof(*girq->parents),
1923 girq->parents[0] = irq;
1924 girq->default_type = IRQ_TYPE_NONE;
1925 girq->handler = handle_edge_irq;
1928 return devm_gpiochip_add_data(&pdev->dev, gc, info);
1931 static const struct of_device_id ocelot_pinctrl_of_match[] = {
1932 { .compatible = "mscc,luton-pinctrl", .data = &luton_desc },
1933 { .compatible = "mscc,serval-pinctrl", .data = &serval_desc },
1934 { .compatible = "mscc,ocelot-pinctrl", .data = &ocelot_desc },
1935 { .compatible = "mscc,jaguar2-pinctrl", .data = &jaguar2_desc },
1936 { .compatible = "mscc,servalt-pinctrl", .data = &servalt_desc },
1937 { .compatible = "microchip,sparx5-pinctrl", .data = &sparx5_desc },
1938 { .compatible = "microchip,lan966x-pinctrl", .data = &lan966x_desc },
1942 static struct regmap *ocelot_pinctrl_create_pincfg(struct platform_device *pdev,
1943 const struct ocelot_pinctrl *info)
1947 const struct regmap_config regmap_config = {
1951 .max_register = info->desc->npins * 4,
1955 base = devm_platform_ioremap_resource(pdev, 1);
1957 dev_dbg(&pdev->dev, "Failed to ioremap config registers (no extended pinconf)\n");
1961 return devm_regmap_init_mmio(&pdev->dev, base, ®map_config);
1964 static int ocelot_pinctrl_probe(struct platform_device *pdev)
1966 const struct ocelot_match_data *data;
1967 struct device *dev = &pdev->dev;
1968 struct ocelot_pinctrl *info;
1969 struct reset_control *reset;
1970 struct regmap *pincfg;
1973 struct regmap_config regmap_config = {
1979 info = devm_kzalloc(dev, sizeof(*info), GFP_KERNEL);
1983 data = device_get_match_data(dev);
1987 info->desc = devm_kmemdup(dev, &data->desc, sizeof(*info->desc),
1992 info->pincfg_data = &data->pincfg_data;
1994 reset = devm_reset_control_get_optional_shared(dev, "switch");
1996 return dev_err_probe(dev, PTR_ERR(reset),
1997 "Failed to get reset\n");
1998 reset_control_reset(reset);
2000 base = devm_ioremap_resource(dev,
2001 platform_get_resource(pdev, IORESOURCE_MEM, 0));
2003 return PTR_ERR(base);
2005 info->stride = 1 + (info->desc->npins - 1) / 32;
2007 regmap_config.max_register = OCELOT_GPIO_SD_MAP * info->stride + 15 * 4;
2009 info->map = devm_regmap_init_mmio(dev, base, ®map_config);
2010 if (IS_ERR(info->map)) {
2011 dev_err(dev, "Failed to create regmap\n");
2012 return PTR_ERR(info->map);
2014 dev_set_drvdata(dev, info->map);
2017 /* Pinconf registers */
2018 if (info->desc->confops) {
2019 pincfg = ocelot_pinctrl_create_pincfg(pdev, info);
2021 dev_dbg(dev, "Failed to create pincfg regmap\n");
2023 info->pincfg = pincfg;
2026 ret = ocelot_pinctrl_register(pdev, info);
2030 ret = ocelot_gpiochip_register(pdev, info);
2034 dev_info(dev, "driver registered\n");
2039 static struct platform_driver ocelot_pinctrl_driver = {
2041 .name = "pinctrl-ocelot",
2042 .of_match_table = of_match_ptr(ocelot_pinctrl_of_match),
2043 .suppress_bind_attrs = true,
2045 .probe = ocelot_pinctrl_probe,
2047 builtin_platform_driver(ocelot_pinctrl_driver);