Re: [PATCH v4 2/2] pinctrl: ocelot: Extend support for lan966x

From: Alexandre Belloni
Date: Thu Nov 18 2021 - 07:07:39 EST


On 18/11/2021 16:55:48+0530, Kavyasree Kotagiri wrote:
> This patch extends pinctrl-ocelot driver to support also the
> lan966x. Register layout is same as ocelot. It has 78 GPIOs.
> Requires 3 registers ALT0, ALT1, ALT2 to configure ALT mode.
>
> Signed-off-by: Kavyasree Kotagiri <kavyasree.kotagiri@xxxxxxxxxxxxx>
Reviewed-by: Alexandre Belloni <alexandre.belloni@xxxxxxxxxxx>

> ---
> v3 -> v4:
> - Minor description fix in lan966x_pinmux_set_mux().
>
> v2 -> v3:
> - Removed extra new lines in pinctrl-ocelot.
> - Reverted sparx5_desc changes which are done by mistake.
>
> v1 -> v2:
> - Use consistent name lan966x everywhere.
>
> drivers/pinctrl/pinctrl-ocelot.c | 416 +++++++++++++++++++++++++++++++
> 1 file changed, 416 insertions(+)
>
> diff --git a/drivers/pinctrl/pinctrl-ocelot.c b/drivers/pinctrl/pinctrl-ocelot.c
> index 0a36ec8775a3..875e3f319d7b 100644
> --- a/drivers/pinctrl/pinctrl-ocelot.c
> +++ b/drivers/pinctrl/pinctrl-ocelot.c
> @@ -57,16 +57,71 @@ enum {
> #define OCELOT_FUNC_PER_PIN 4
>
> enum {
> + FUNC_CAN0_a,
> + FUNC_CAN0_b,
> + FUNC_CAN1,
> FUNC_NONE,
> + FUNC_FC0_a,
> + FUNC_FC0_b,
> + FUNC_FC0_c,
> + FUNC_FC1_a,
> + FUNC_FC1_b,
> + FUNC_FC1_c,
> + FUNC_FC2_a,
> + FUNC_FC2_b,
> + FUNC_FC3_a,
> + FUNC_FC3_b,
> + FUNC_FC3_c,
> + FUNC_FC4_a,
> + FUNC_FC4_b,
> + FUNC_FC4_c,
> + FUNC_FC_SHRD0,
> + FUNC_FC_SHRD1,
> + FUNC_FC_SHRD2,
> + FUNC_FC_SHRD3,
> + FUNC_FC_SHRD4,
> + FUNC_FC_SHRD5,
> + FUNC_FC_SHRD6,
> + FUNC_FC_SHRD7,
> + FUNC_FC_SHRD8,
> + FUNC_FC_SHRD9,
> + FUNC_FC_SHRD10,
> + FUNC_FC_SHRD11,
> + FUNC_FC_SHRD12,
> + FUNC_FC_SHRD13,
> + FUNC_FC_SHRD14,
> + FUNC_FC_SHRD15,
> + FUNC_FC_SHRD16,
> + FUNC_FC_SHRD17,
> + FUNC_FC_SHRD18,
> + FUNC_FC_SHRD19,
> + FUNC_FC_SHRD20,
> FUNC_GPIO,
> + FUNC_IB_TRG_a,
> + FUNC_IB_TRG_b,
> + FUNC_IB_TRG_c,
> FUNC_IRQ0,
> + FUNC_IRQ_IN_a,
> + FUNC_IRQ_IN_b,
> + FUNC_IRQ_IN_c,
> FUNC_IRQ0_IN,
> + FUNC_IRQ_OUT_a,
> + FUNC_IRQ_OUT_b,
> + FUNC_IRQ_OUT_c,
> FUNC_IRQ0_OUT,
> FUNC_IRQ1,
> FUNC_IRQ1_IN,
> FUNC_IRQ1_OUT,
> FUNC_EXT_IRQ,
> FUNC_MIIM,
> + FUNC_MIIM_a,
> + FUNC_MIIM_b,
> + FUNC_MIIM_c,
> + FUNC_MIIM_Sa,
> + FUNC_MIIM_Sb,
> + FUNC_OB_TRG,
> + FUNC_OB_TRG_a,
> + FUNC_OB_TRG_b,
> FUNC_PHY_LED,
> FUNC_PCI_WAKE,
> FUNC_MD,
> @@ -74,65 +129,174 @@ enum {
> FUNC_PTP1,
> FUNC_PTP2,
> FUNC_PTP3,
> + FUNC_PTPSYNC_1,
> + FUNC_PTPSYNC_2,
> + FUNC_PTPSYNC_3,
> + FUNC_PTPSYNC_4,
> + FUNC_PTPSYNC_5,
> + FUNC_PTPSYNC_6,
> + FUNC_PTPSYNC_7,
> FUNC_PWM,
> + FUNC_QSPI1,
> + FUNC_QSPI2,
> + FUNC_R,
> + FUNC_RECO_a,
> + FUNC_RECO_b,
> FUNC_RECO_CLK,
> + FUNC_SD,
> FUNC_SFP,
> + FUNC_SFP_SD,
> FUNC_SG0,
> FUNC_SG1,
> FUNC_SG2,
> + FUNC_SGPIO_a,
> + FUNC_SGPIO_b,
> FUNC_SI,
> FUNC_SI2,
> FUNC_TACHO,
> + FUNC_TACHO_a,
> + FUNC_TACHO_b,
> FUNC_TWI,
> FUNC_TWI2,
> FUNC_TWI3,
> FUNC_TWI_SCL_M,
> + FUNC_TWI_SLC_GATE,
> + FUNC_TWI_SLC_GATE_AD,
> FUNC_UART,
> FUNC_UART2,
> FUNC_UART3,
> + FUNC_USB_H_a,
> + FUNC_USB_H_b,
> + FUNC_USB_H_c,
> + FUNC_USB_S_a,
> + FUNC_USB_S_b,
> + FUNC_USB_S_c,
> FUNC_PLL_STAT,
> FUNC_EMMC,
> + FUNC_EMMC_SD,
> FUNC_REF_CLK,
> FUNC_RCVRD_CLK,
> FUNC_MAX
> };
>
> static const char *const ocelot_function_names[] = {
> + [FUNC_CAN0_a] = "can0_a",
> + [FUNC_CAN0_b] = "can0_b",
> + [FUNC_CAN1] = "can1",
> [FUNC_NONE] = "none",
> + [FUNC_FC0_a] = "fc0_a",
> + [FUNC_FC0_b] = "fc0_b",
> + [FUNC_FC0_c] = "fc0_c",
> + [FUNC_FC1_a] = "fc1_a",
> + [FUNC_FC1_b] = "fc1_b",
> + [FUNC_FC1_c] = "fc1_c",
> + [FUNC_FC2_a] = "fc2_a",
> + [FUNC_FC2_b] = "fc2_b",
> + [FUNC_FC3_a] = "fc3_a",
> + [FUNC_FC3_b] = "fc3_b",
> + [FUNC_FC3_c] = "fc3_c",
> + [FUNC_FC4_a] = "fc4_a",
> + [FUNC_FC4_b] = "fc4_b",
> + [FUNC_FC4_c] = "fc4_c",
> + [FUNC_FC_SHRD0] = "fc_shrd0",
> + [FUNC_FC_SHRD1] = "fc_shrd1",
> + [FUNC_FC_SHRD2] = "fc_shrd2",
> + [FUNC_FC_SHRD3] = "fc_shrd3",
> + [FUNC_FC_SHRD4] = "fc_shrd4",
> + [FUNC_FC_SHRD5] = "fc_shrd5",
> + [FUNC_FC_SHRD6] = "fc_shrd6",
> + [FUNC_FC_SHRD7] = "fc_shrd7",
> + [FUNC_FC_SHRD8] = "fc_shrd8",
> + [FUNC_FC_SHRD9] = "fc_shrd9",
> + [FUNC_FC_SHRD10] = "fc_shrd10",
> + [FUNC_FC_SHRD11] = "fc_shrd11",
> + [FUNC_FC_SHRD12] = "fc_shrd12",
> + [FUNC_FC_SHRD13] = "fc_shrd13",
> + [FUNC_FC_SHRD14] = "fc_shrd14",
> + [FUNC_FC_SHRD15] = "fc_shrd15",
> + [FUNC_FC_SHRD16] = "fc_shrd16",
> + [FUNC_FC_SHRD17] = "fc_shrd17",
> + [FUNC_FC_SHRD18] = "fc_shrd18",
> + [FUNC_FC_SHRD19] = "fc_shrd19",
> + [FUNC_FC_SHRD20] = "fc_shrd20",
> [FUNC_GPIO] = "gpio",
> + [FUNC_IB_TRG_a] = "ib_trig_a",
> + [FUNC_IB_TRG_b] = "ib_trig_b",
> + [FUNC_IB_TRG_c] = "ib_trig_c",
> [FUNC_IRQ0] = "irq0",
> + [FUNC_IRQ_IN_a] = "irq_in_a",
> + [FUNC_IRQ_IN_b] = "irq_in_b",
> + [FUNC_IRQ_IN_c] = "irq_in_c",
> [FUNC_IRQ0_IN] = "irq0_in",
> + [FUNC_IRQ_OUT_a] = "irq_out_a",
> + [FUNC_IRQ_OUT_b] = "irq_out_b",
> + [FUNC_IRQ_OUT_c] = "irq_out_c",
> [FUNC_IRQ0_OUT] = "irq0_out",
> [FUNC_IRQ1] = "irq1",
> [FUNC_IRQ1_IN] = "irq1_in",
> [FUNC_IRQ1_OUT] = "irq1_out",
> [FUNC_EXT_IRQ] = "ext_irq",
> [FUNC_MIIM] = "miim",
> + [FUNC_MIIM_a] = "miim_a",
> + [FUNC_MIIM_b] = "miim_b",
> + [FUNC_MIIM_c] = "miim_c",
> + [FUNC_MIIM_Sa] = "miim_slave_a",
> + [FUNC_MIIM_Sb] = "miim_slave_b",
> [FUNC_PHY_LED] = "phy_led",
> [FUNC_PCI_WAKE] = "pci_wake",
> [FUNC_MD] = "md",
> + [FUNC_OB_TRG] = "ob_trig",
> + [FUNC_OB_TRG_a] = "ob_trig_a",
> + [FUNC_OB_TRG_b] = "ob_trig_b",
> [FUNC_PTP0] = "ptp0",
> [FUNC_PTP1] = "ptp1",
> [FUNC_PTP2] = "ptp2",
> [FUNC_PTP3] = "ptp3",
> + [FUNC_PTPSYNC_1] = "ptpsync_1",
> + [FUNC_PTPSYNC_2] = "ptpsync_2",
> + [FUNC_PTPSYNC_3] = "ptpsync_3",
> + [FUNC_PTPSYNC_4] = "ptpsync_4",
> + [FUNC_PTPSYNC_5] = "ptpsync_5",
> + [FUNC_PTPSYNC_6] = "ptpsync_6",
> + [FUNC_PTPSYNC_7] = "ptpsync_7",
> [FUNC_PWM] = "pwm",
> + [FUNC_QSPI1] = "qspi1",
> + [FUNC_QSPI2] = "qspi2",
> + [FUNC_R] = "reserved",
> + [FUNC_RECO_a] = "reco_a",
> + [FUNC_RECO_b] = "reco_b",
> [FUNC_RECO_CLK] = "reco_clk",
> + [FUNC_SD] = "sd",
> [FUNC_SFP] = "sfp",
> + [FUNC_SFP_SD] = "sfp_sd",
> [FUNC_SG0] = "sg0",
> [FUNC_SG1] = "sg1",
> [FUNC_SG2] = "sg2",
> + [FUNC_SGPIO_a] = "sgpio_a",
> + [FUNC_SGPIO_b] = "sgpio_b",
> [FUNC_SI] = "si",
> [FUNC_SI2] = "si2",
> [FUNC_TACHO] = "tacho",
> + [FUNC_TACHO_a] = "tacho_a",
> + [FUNC_TACHO_b] = "tacho_b",
> [FUNC_TWI] = "twi",
> [FUNC_TWI2] = "twi2",
> [FUNC_TWI3] = "twi3",
> [FUNC_TWI_SCL_M] = "twi_scl_m",
> + [FUNC_TWI_SLC_GATE] = "twi_slc_gate",
> + [FUNC_TWI_SLC_GATE_AD] = "twi_slc_gate_ad",
> + [FUNC_USB_H_a] = "usb_host_a",
> + [FUNC_USB_H_b] = "usb_host_b",
> + [FUNC_USB_H_c] = "usb_host_c",
> + [FUNC_USB_S_a] = "usb_slave_a",
> + [FUNC_USB_S_b] = "usb_slave_b",
> + [FUNC_USB_S_c] = "usb_slave_c",
> [FUNC_UART] = "uart",
> [FUNC_UART2] = "uart2",
> [FUNC_UART3] = "uart3",
> [FUNC_PLL_STAT] = "pll_stat",
> [FUNC_EMMC] = "emmc",
> + [FUNC_EMMC_SD] = "emmc_sd",
> [FUNC_REF_CLK] = "ref_clk",
> [FUNC_RCVRD_CLK] = "rcvrd_clk",
> };
> @@ -145,6 +309,7 @@ struct ocelot_pmx_func {
> struct ocelot_pin_caps {
> unsigned int pin;
> unsigned char functions[OCELOT_FUNC_PER_PIN];
> + unsigned char a_functions[OCELOT_FUNC_PER_PIN]; /* Additional functions */
> };
>
> struct ocelot_pinctrl {
> @@ -676,6 +841,187 @@ static const struct pinctrl_pin_desc sparx5_pins[] = {
> SPARX5_PIN(63),
> };
>
> +#define LAN966X_P(p, f0, f1, f2, f3, f4, f5, f6, f7) \
> +static struct ocelot_pin_caps lan966x_pin_##p = { \
> + .pin = p, \
> + .functions = { \
> + FUNC_##f0, FUNC_##f1, FUNC_##f2, \
> + FUNC_##f3 \
> + }, \
> + .a_functions = { \
> + FUNC_##f4, FUNC_##f5, FUNC_##f6, \
> + FUNC_##f7 \
> + }, \
> +}
> +
> +/* Pinmuxing table taken from data sheet */
> +/* Pin FUNC0 FUNC1 FUNC2 FUNC3 FUNC4 FUNC5 FUNC6 FUNC7 */
> +LAN966X_P(0, GPIO, NONE, NONE, NONE, NONE, NONE, NONE, R);
> +LAN966X_P(1, GPIO, NONE, NONE, NONE, NONE, NONE, NONE, R);
> +LAN966X_P(2, GPIO, NONE, NONE, NONE, NONE, NONE, NONE, R);
> +LAN966X_P(3, GPIO, NONE, NONE, NONE, NONE, NONE, NONE, R);
> +LAN966X_P(4, GPIO, NONE, NONE, NONE, NONE, NONE, NONE, R);
> +LAN966X_P(5, GPIO, NONE, NONE, NONE, NONE, NONE, NONE, R);
> +LAN966X_P(6, GPIO, NONE, NONE, NONE, NONE, NONE, NONE, R);
> +LAN966X_P(7, GPIO, NONE, NONE, NONE, NONE, NONE, NONE, R);
> +LAN966X_P(8, GPIO, FC0_a, USB_H_b, NONE, USB_S_b, NONE, NONE, R);
> +LAN966X_P(9, GPIO, FC0_a, USB_H_b, NONE, NONE, NONE, NONE, R);
> +LAN966X_P(10, GPIO, FC0_a, NONE, NONE, NONE, NONE, NONE, R);
> +LAN966X_P(11, GPIO, FC1_a, NONE, NONE, NONE, NONE, NONE, R);
> +LAN966X_P(12, GPIO, FC1_a, NONE, NONE, NONE, NONE, NONE, R);
> +LAN966X_P(13, GPIO, FC1_a, NONE, NONE, NONE, NONE, NONE, R);
> +LAN966X_P(14, GPIO, FC2_a, NONE, NONE, NONE, NONE, NONE, R);
> +LAN966X_P(15, GPIO, FC2_a, NONE, NONE, NONE, NONE, NONE, R);
> +LAN966X_P(16, GPIO, FC2_a, IB_TRG_a, NONE, OB_TRG_a, IRQ_IN_c, IRQ_OUT_c, R);
> +LAN966X_P(17, GPIO, FC3_a, IB_TRG_a, NONE, OB_TRG_a, IRQ_IN_c, IRQ_OUT_c, R);
> +LAN966X_P(18, GPIO, FC3_a, IB_TRG_a, NONE, OB_TRG_a, IRQ_IN_c, IRQ_OUT_c, R);
> +LAN966X_P(19, GPIO, FC3_a, IB_TRG_a, NONE, OB_TRG_a, IRQ_IN_c, IRQ_OUT_c, R);
> +LAN966X_P(20, GPIO, FC4_a, IB_TRG_a, NONE, OB_TRG_a, IRQ_IN_c, NONE, R);
> +LAN966X_P(21, GPIO, FC4_a, NONE, NONE, OB_TRG_a, NONE, NONE, R);
> +LAN966X_P(22, GPIO, FC4_a, NONE, NONE, OB_TRG_a, NONE, NONE, R);
> +LAN966X_P(23, GPIO, NONE, NONE, NONE, OB_TRG_a, NONE, NONE, R);
> +LAN966X_P(24, GPIO, FC0_b, IB_TRG_a, USB_H_c, OB_TRG_a, IRQ_IN_c, TACHO_a, R);
> +LAN966X_P(25, GPIO, FC0_b, IB_TRG_a, USB_H_c, OB_TRG_a, IRQ_OUT_c, SFP_SD, R);
> +LAN966X_P(26, GPIO, FC0_b, IB_TRG_a, USB_S_c, OB_TRG_a, CAN0_a, SFP_SD, R);
> +LAN966X_P(27, GPIO, NONE, NONE, NONE, OB_TRG_a, CAN0_a, NONE, R);
> +LAN966X_P(28, GPIO, MIIM_a, NONE, NONE, OB_TRG_a, IRQ_OUT_c, SFP_SD, R);
> +LAN966X_P(29, GPIO, MIIM_a, NONE, NONE, OB_TRG_a, NONE, NONE, R);
> +LAN966X_P(30, GPIO, FC3_c, CAN1, NONE, OB_TRG, RECO_b, NONE, R);
> +LAN966X_P(31, GPIO, FC3_c, CAN1, NONE, OB_TRG, RECO_b, NONE, R);
> +LAN966X_P(32, GPIO, FC3_c, NONE, SGPIO_a, NONE, MIIM_Sa, NONE, R);
> +LAN966X_P(33, GPIO, FC1_b, NONE, SGPIO_a, NONE, MIIM_Sa, MIIM_b, R);
> +LAN966X_P(34, GPIO, FC1_b, NONE, SGPIO_a, NONE, MIIM_Sa, MIIM_b, R);
> +LAN966X_P(35, GPIO, FC1_b, NONE, SGPIO_a, CAN0_b, NONE, NONE, R);
> +LAN966X_P(36, GPIO, NONE, PTPSYNC_1, NONE, CAN0_b, NONE, NONE, R);
> +LAN966X_P(37, GPIO, FC_SHRD0, PTPSYNC_2, TWI_SLC_GATE_AD, NONE, NONE, NONE, R);
> +LAN966X_P(38, GPIO, NONE, PTPSYNC_3, NONE, NONE, NONE, NONE, R);
> +LAN966X_P(39, GPIO, NONE, PTPSYNC_4, NONE, NONE, NONE, NONE, R);
> +LAN966X_P(40, GPIO, FC_SHRD1, PTPSYNC_5, NONE, NONE, NONE, NONE, R);
> +LAN966X_P(41, GPIO, FC_SHRD2, PTPSYNC_6, TWI_SLC_GATE_AD, NONE, NONE, NONE, R);
> +LAN966X_P(42, GPIO, FC_SHRD3, PTPSYNC_7, TWI_SLC_GATE_AD, NONE, NONE, NONE, R);
> +LAN966X_P(43, GPIO, FC2_b, OB_TRG_b, IB_TRG_b, IRQ_OUT_a, RECO_a, IRQ_IN_a, R);
> +LAN966X_P(44, GPIO, FC2_b, OB_TRG_b, IB_TRG_b, IRQ_OUT_a, RECO_a, IRQ_IN_a, R);
> +LAN966X_P(45, GPIO, FC2_b, OB_TRG_b, IB_TRG_b, IRQ_OUT_a, NONE, IRQ_IN_a, R);
> +LAN966X_P(46, GPIO, FC1_c, OB_TRG_b, IB_TRG_b, IRQ_OUT_a, FC_SHRD4, IRQ_IN_a, R);
> +LAN966X_P(47, GPIO, FC1_c, OB_TRG_b, IB_TRG_b, IRQ_OUT_a, FC_SHRD5, IRQ_IN_a, R);
> +LAN966X_P(48, GPIO, FC1_c, OB_TRG_b, IB_TRG_b, IRQ_OUT_a, FC_SHRD6, IRQ_IN_a, R);
> +LAN966X_P(49, GPIO, FC_SHRD7, OB_TRG_b, IB_TRG_b, IRQ_OUT_a, TWI_SLC_GATE, IRQ_IN_a, R);
> +LAN966X_P(50, GPIO, FC_SHRD16, OB_TRG_b, IB_TRG_b, IRQ_OUT_a, TWI_SLC_GATE, NONE, R);
> +LAN966X_P(51, GPIO, FC3_b, OB_TRG_b, IB_TRG_c, IRQ_OUT_b, NONE, IRQ_IN_b, R);
> +LAN966X_P(52, GPIO, FC3_b, OB_TRG_b, IB_TRG_c, IRQ_OUT_b, TACHO_b, IRQ_IN_b, R);
> +LAN966X_P(53, GPIO, FC3_b, OB_TRG_b, IB_TRG_c, IRQ_OUT_b, NONE, IRQ_IN_b, R);
> +LAN966X_P(54, GPIO, FC_SHRD8, OB_TRG_b, IB_TRG_c, IRQ_OUT_b, TWI_SLC_GATE, IRQ_IN_b, R);
> +LAN966X_P(55, GPIO, FC_SHRD9, OB_TRG_b, IB_TRG_c, IRQ_OUT_b, TWI_SLC_GATE, IRQ_IN_b, R);
> +LAN966X_P(56, GPIO, FC4_b, OB_TRG_b, IB_TRG_c, IRQ_OUT_b, FC_SHRD10, IRQ_IN_b, R);
> +LAN966X_P(57, GPIO, FC4_b, TWI_SLC_GATE, IB_TRG_c, IRQ_OUT_b, FC_SHRD11, IRQ_IN_b, R);
> +LAN966X_P(58, GPIO, FC4_b, TWI_SLC_GATE, IB_TRG_c, IRQ_OUT_b, FC_SHRD12, IRQ_IN_b, R);
> +LAN966X_P(59, GPIO, QSPI1, MIIM_c, NONE, NONE, MIIM_Sb, NONE, R);
> +LAN966X_P(60, GPIO, QSPI1, MIIM_c, NONE, NONE, MIIM_Sb, NONE, R);
> +LAN966X_P(61, GPIO, QSPI1, NONE, SGPIO_b, FC0_c, MIIM_Sb, NONE, R);
> +LAN966X_P(62, GPIO, QSPI1, FC_SHRD13, SGPIO_b, FC0_c, TWI_SLC_GATE, SFP_SD, R);
> +LAN966X_P(63, GPIO, QSPI1, FC_SHRD14, SGPIO_b, FC0_c, TWI_SLC_GATE, SFP_SD, R);
> +LAN966X_P(64, GPIO, QSPI1, FC4_c, SGPIO_b, FC_SHRD15, TWI_SLC_GATE, SFP_SD, R);
> +LAN966X_P(65, GPIO, USB_H_a, FC4_c, NONE, IRQ_OUT_c, TWI_SLC_GATE_AD, NONE, R);
> +LAN966X_P(66, GPIO, USB_H_a, FC4_c, USB_S_a, IRQ_OUT_c, IRQ_IN_c, NONE, R);
> +LAN966X_P(67, GPIO, EMMC_SD, NONE, QSPI2, NONE, NONE, NONE, R);
> +LAN966X_P(68, GPIO, EMMC_SD, NONE, QSPI2, NONE, NONE, NONE, R);
> +LAN966X_P(69, GPIO, EMMC_SD, NONE, QSPI2, NONE, NONE, NONE, R);
> +LAN966X_P(70, GPIO, EMMC_SD, NONE, QSPI2, NONE, NONE, NONE, R);
> +LAN966X_P(71, GPIO, EMMC_SD, NONE, QSPI2, NONE, NONE, NONE, R);
> +LAN966X_P(72, GPIO, EMMC_SD, NONE, QSPI2, NONE, NONE, NONE, R);
> +LAN966X_P(73, GPIO, EMMC, NONE, NONE, SD, NONE, NONE, R);
> +LAN966X_P(74, GPIO, EMMC, NONE, FC_SHRD17, SD, TWI_SLC_GATE, NONE, R);
> +LAN966X_P(75, GPIO, EMMC, NONE, FC_SHRD18, SD, TWI_SLC_GATE, NONE, R);
> +LAN966X_P(76, GPIO, EMMC, NONE, FC_SHRD19, SD, TWI_SLC_GATE, NONE, R);
> +LAN966X_P(77, GPIO, EMMC_SD, NONE, FC_SHRD20, NONE, TWI_SLC_GATE, NONE, R);
> +
> +#define LAN966X_PIN(n) { \
> + .number = n, \
> + .name = "GPIO_"#n, \
> + .drv_data = &lan966x_pin_##n \
> +}
> +
> +static const struct pinctrl_pin_desc lan966x_pins[] = {
> + LAN966X_PIN(0),
> + LAN966X_PIN(1),
> + LAN966X_PIN(2),
> + LAN966X_PIN(3),
> + LAN966X_PIN(4),
> + LAN966X_PIN(5),
> + LAN966X_PIN(6),
> + LAN966X_PIN(7),
> + LAN966X_PIN(8),
> + LAN966X_PIN(9),
> + LAN966X_PIN(10),
> + LAN966X_PIN(11),
> + LAN966X_PIN(12),
> + LAN966X_PIN(13),
> + LAN966X_PIN(14),
> + LAN966X_PIN(15),
> + LAN966X_PIN(16),
> + LAN966X_PIN(17),
> + LAN966X_PIN(18),
> + LAN966X_PIN(19),
> + LAN966X_PIN(20),
> + LAN966X_PIN(21),
> + LAN966X_PIN(22),
> + LAN966X_PIN(23),
> + LAN966X_PIN(24),
> + LAN966X_PIN(25),
> + LAN966X_PIN(26),
> + LAN966X_PIN(27),
> + LAN966X_PIN(28),
> + LAN966X_PIN(29),
> + LAN966X_PIN(30),
> + LAN966X_PIN(31),
> + LAN966X_PIN(32),
> + LAN966X_PIN(33),
> + LAN966X_PIN(34),
> + LAN966X_PIN(35),
> + LAN966X_PIN(36),
> + LAN966X_PIN(37),
> + LAN966X_PIN(38),
> + LAN966X_PIN(39),
> + LAN966X_PIN(40),
> + LAN966X_PIN(41),
> + LAN966X_PIN(42),
> + LAN966X_PIN(43),
> + LAN966X_PIN(44),
> + LAN966X_PIN(45),
> + LAN966X_PIN(46),
> + LAN966X_PIN(47),
> + LAN966X_PIN(48),
> + LAN966X_PIN(49),
> + LAN966X_PIN(50),
> + LAN966X_PIN(51),
> + LAN966X_PIN(52),
> + LAN966X_PIN(53),
> + LAN966X_PIN(54),
> + LAN966X_PIN(55),
> + LAN966X_PIN(56),
> + LAN966X_PIN(57),
> + LAN966X_PIN(58),
> + LAN966X_PIN(59),
> + LAN966X_PIN(60),
> + LAN966X_PIN(61),
> + LAN966X_PIN(62),
> + LAN966X_PIN(63),
> + LAN966X_PIN(64),
> + LAN966X_PIN(65),
> + LAN966X_PIN(66),
> + LAN966X_PIN(67),
> + LAN966X_PIN(68),
> + LAN966X_PIN(69),
> + LAN966X_PIN(70),
> + LAN966X_PIN(71),
> + LAN966X_PIN(72),
> + LAN966X_PIN(73),
> + LAN966X_PIN(74),
> + LAN966X_PIN(75),
> + LAN966X_PIN(76),
> + LAN966X_PIN(77),
> +};
> +
> static int ocelot_get_functions_count(struct pinctrl_dev *pctldev)
> {
> return ARRAY_SIZE(ocelot_function_names);
> @@ -709,6 +1055,9 @@ static int ocelot_pin_function_idx(struct ocelot_pinctrl *info,
> for (i = 0; i < OCELOT_FUNC_PER_PIN; i++) {
> if (function == p->functions[i])
> return i;
> +
> + if (function == p->a_functions[i])
> + return i + OCELOT_FUNC_PER_PIN;
> }
>
> return -1;
> @@ -744,6 +1093,36 @@ static int ocelot_pinmux_set_mux(struct pinctrl_dev *pctldev,
> return 0;
> }
>
> +static int lan966x_pinmux_set_mux(struct pinctrl_dev *pctldev,
> + unsigned int selector, unsigned int group)
> +{
> + struct ocelot_pinctrl *info = pinctrl_dev_get_drvdata(pctldev);
> + struct ocelot_pin_caps *pin = info->desc->pins[group].drv_data;
> + unsigned int p = pin->pin % 32;
> + int f;
> +
> + f = ocelot_pin_function_idx(info, group, selector);
> + if (f < 0)
> + return -EINVAL;
> +
> + /*
> + * f is encoded on three bits.
> + * bit 0 of f goes in BIT(pin) of ALT[0], bit 1 of f goes in BIT(pin) of
> + * ALT[1], bit 2 of f goes in BIT(pin) of ALT[2]
> + * This is racy because three registers can't be updated at the same time
> + * but it doesn't matter much for now.
> + * Note: ALT0/ALT1/ALT2 are organized specially for 78 gpio targets
> + */
> + regmap_update_bits(info->map, REG_ALT(0, info, pin->pin),
> + BIT(p), f << p);
> + regmap_update_bits(info->map, REG_ALT(1, info, pin->pin),
> + BIT(p), (f >> 1) << p);
> + regmap_update_bits(info->map, REG_ALT(2, info, pin->pin),
> + BIT(p), (f >> 2) << p);
> +
> + return 0;
> +}
> +
> #define REG(r, info, p) ((r) * (info)->stride + (4 * ((p) / 32)))
>
> static int ocelot_gpio_set_direction(struct pinctrl_dev *pctldev,
> @@ -774,6 +1153,23 @@ static int ocelot_gpio_request_enable(struct pinctrl_dev *pctldev,
> return 0;
> }
>
> +static int lan966x_gpio_request_enable(struct pinctrl_dev *pctldev,
> + struct pinctrl_gpio_range *range,
> + unsigned int offset)
> +{
> + struct ocelot_pinctrl *info = pinctrl_dev_get_drvdata(pctldev);
> + unsigned int p = offset % 32;
> +
> + regmap_update_bits(info->map, REG_ALT(0, info, offset),
> + BIT(p), 0);
> + regmap_update_bits(info->map, REG_ALT(1, info, offset),
> + BIT(p), 0);
> + regmap_update_bits(info->map, REG_ALT(2, info, offset),
> + BIT(p), 0);
> +
> + return 0;
> +}
> +
> static const struct pinmux_ops ocelot_pmx_ops = {
> .get_functions_count = ocelot_get_functions_count,
> .get_function_name = ocelot_get_function_name,
> @@ -783,6 +1179,15 @@ static const struct pinmux_ops ocelot_pmx_ops = {
> .gpio_request_enable = ocelot_gpio_request_enable,
> };
>
> +static const struct pinmux_ops lan966x_pmx_ops = {
> + .get_functions_count = ocelot_get_functions_count,
> + .get_function_name = ocelot_get_function_name,
> + .get_function_groups = ocelot_get_function_groups,
> + .set_mux = lan966x_pinmux_set_mux,
> + .gpio_set_direction = ocelot_gpio_set_direction,
> + .gpio_request_enable = lan966x_gpio_request_enable,
> +};
> +
> static int ocelot_pctl_get_groups_count(struct pinctrl_dev *pctldev)
> {
> struct ocelot_pinctrl *info = pinctrl_dev_get_drvdata(pctldev);
> @@ -1078,6 +1483,16 @@ static struct pinctrl_desc sparx5_desc = {
> .owner = THIS_MODULE,
> };
>
> +static struct pinctrl_desc lan966x_desc = {
> + .name = "lan966x-pinctrl",
> + .pins = lan966x_pins,
> + .npins = ARRAY_SIZE(lan966x_pins),
> + .pctlops = &ocelot_pctl_ops,
> + .pmxops = &lan966x_pmx_ops,
> + .confops = &ocelot_confops,
> + .owner = THIS_MODULE,
> +};
> +
> static int ocelot_create_group_func_map(struct device *dev,
> struct ocelot_pinctrl *info)
> {
> @@ -1337,6 +1752,7 @@ static const struct of_device_id ocelot_pinctrl_of_match[] = {
> { .compatible = "mscc,ocelot-pinctrl", .data = &ocelot_desc },
> { .compatible = "mscc,jaguar2-pinctrl", .data = &jaguar2_desc },
> { .compatible = "microchip,sparx5-pinctrl", .data = &sparx5_desc },
> + { .compatible = "microchip,lan966x-pinctrl", .data = &lan966x_desc },
> {},
> };
>
> --
> 2.17.1
>

--
Alexandre Belloni, co-owner and COO, Bootlin
Embedded Linux and Kernel engineering
https://bootlin.com