1 // SPDX-License-Identifier: (GPL-2.0 OR MIT) 2 /* 3 * Microsemi SoCs pinctrl driver 4 * 5 * Author: <alexandre.belloni@free-electrons.com> 6 * License: Dual MIT/GPL 7 * Copyright (c) 2017 Microsemi Corporation 8 */ 9 10 #include <linux/gpio/driver.h> 11 #include <linux/interrupt.h> 12 #include <linux/io.h> 13 #include <linux/mfd/ocelot.h> 14 #include <linux/of.h> 15 #include <linux/platform_device.h> 16 #include <linux/regmap.h> 17 #include <linux/reset.h> 18 #include <linux/slab.h> 19 20 #include <linux/pinctrl/consumer.h> 21 #include <linux/pinctrl/pinconf-generic.h> 22 #include <linux/pinctrl/pinconf.h> 23 #include <linux/pinctrl/pinctrl.h> 24 #include <linux/pinctrl/pinmux.h> 25 26 #include "core.h" 27 #include "pinconf.h" 28 #include "pinmux.h" 29 30 #define ocelot_clrsetbits(addr, clear, set) \ 31 writel((readl(addr) & ~(clear)) | (set), (addr)) 32 33 enum { 34 PINCONF_BIAS, 35 PINCONF_SCHMITT, 36 PINCONF_DRIVE_STRENGTH, 37 }; 38 39 /* GPIO standard registers */ 40 #define OCELOT_GPIO_OUT_SET 0x0 41 #define OCELOT_GPIO_OUT_CLR 0x4 42 #define OCELOT_GPIO_OUT 0x8 43 #define OCELOT_GPIO_IN 0xc 44 #define OCELOT_GPIO_OE 0x10 45 #define OCELOT_GPIO_INTR 0x14 46 #define OCELOT_GPIO_INTR_ENA 0x18 47 #define OCELOT_GPIO_INTR_IDENT 0x1c 48 #define OCELOT_GPIO_ALT0 0x20 49 #define OCELOT_GPIO_ALT1 0x24 50 #define OCELOT_GPIO_SD_MAP 0x28 51 52 #define OCELOT_FUNC_PER_PIN 4 53 54 enum { 55 FUNC_CAN0_a, 56 FUNC_CAN0_b, 57 FUNC_CAN1, 58 FUNC_CLKMON, 59 FUNC_NONE, 60 FUNC_FC0_a, 61 FUNC_FC0_b, 62 FUNC_FC0_c, 63 FUNC_FC1_a, 64 FUNC_FC1_b, 65 FUNC_FC1_c, 66 FUNC_FC2_a, 67 FUNC_FC2_b, 68 FUNC_FC3_a, 69 FUNC_FC3_b, 70 FUNC_FC3_c, 71 FUNC_FC4_a, 72 FUNC_FC4_b, 73 FUNC_FC4_c, 74 FUNC_FC_SHRD0, 75 FUNC_FC_SHRD1, 76 FUNC_FC_SHRD2, 77 FUNC_FC_SHRD3, 78 FUNC_FC_SHRD4, 79 FUNC_FC_SHRD5, 80 FUNC_FC_SHRD6, 81 FUNC_FC_SHRD7, 82 FUNC_FC_SHRD8, 83 FUNC_FC_SHRD9, 84 FUNC_FC_SHRD10, 85 FUNC_FC_SHRD11, 86 FUNC_FC_SHRD12, 87 FUNC_FC_SHRD13, 88 FUNC_FC_SHRD14, 89 FUNC_FC_SHRD15, 90 FUNC_FC_SHRD16, 91 FUNC_FC_SHRD17, 92 FUNC_FC_SHRD18, 93 FUNC_FC_SHRD19, 94 FUNC_FC_SHRD20, 95 FUNC_GPIO, 96 FUNC_IB_TRG_a, 97 FUNC_IB_TRG_b, 98 FUNC_IB_TRG_c, 99 FUNC_IRQ0, 100 FUNC_IRQ_IN_a, 101 FUNC_IRQ_IN_b, 102 FUNC_IRQ_IN_c, 103 FUNC_IRQ0_IN, 104 FUNC_IRQ_OUT_a, 105 FUNC_IRQ_OUT_b, 106 FUNC_IRQ_OUT_c, 107 FUNC_IRQ0_OUT, 108 FUNC_IRQ1, 109 FUNC_IRQ1_IN, 110 FUNC_IRQ1_OUT, 111 FUNC_EXT_IRQ, 112 FUNC_MIIM, 113 FUNC_MIIM_a, 114 FUNC_MIIM_b, 115 FUNC_MIIM_c, 116 FUNC_MIIM_Sa, 117 FUNC_MIIM_Sb, 118 FUNC_OB_TRG, 119 FUNC_OB_TRG_a, 120 FUNC_OB_TRG_b, 121 FUNC_PHY_LED, 122 FUNC_PCI_WAKE, 123 FUNC_MD, 124 FUNC_PTP0, 125 FUNC_PTP1, 126 FUNC_PTP2, 127 FUNC_PTP3, 128 FUNC_PTPSYNC_0, 129 FUNC_PTPSYNC_1, 130 FUNC_PTPSYNC_2, 131 FUNC_PTPSYNC_3, 132 FUNC_PTPSYNC_4, 133 FUNC_PTPSYNC_5, 134 FUNC_PTPSYNC_6, 135 FUNC_PTPSYNC_7, 136 FUNC_PWM, 137 FUNC_PWM_a, 138 FUNC_PWM_b, 139 FUNC_QSPI1, 140 FUNC_QSPI2, 141 FUNC_R, 142 FUNC_RECO_a, 143 FUNC_RECO_b, 144 FUNC_RECO_CLK, 145 FUNC_SD, 146 FUNC_SFP, 147 FUNC_SFP_SD, 148 FUNC_SG0, 149 FUNC_SG1, 150 FUNC_SG2, 151 FUNC_SGPIO_a, 152 FUNC_SGPIO_b, 153 FUNC_SI, 154 FUNC_SI2, 155 FUNC_TACHO, 156 FUNC_TACHO_a, 157 FUNC_TACHO_b, 158 FUNC_TWI, 159 FUNC_TWI2, 160 FUNC_TWI3, 161 FUNC_TWI_SCL_M, 162 FUNC_TWI_SLC_GATE, 163 FUNC_TWI_SLC_GATE_AD, 164 FUNC_UART, 165 FUNC_UART2, 166 FUNC_UART3, 167 FUNC_USB_H_a, 168 FUNC_USB_H_b, 169 FUNC_USB_H_c, 170 FUNC_USB_S_a, 171 FUNC_USB_S_b, 172 FUNC_USB_S_c, 173 FUNC_PLL_STAT, 174 FUNC_EMMC, 175 FUNC_EMMC_SD, 176 FUNC_REF_CLK, 177 FUNC_RCVRD_CLK, 178 FUNC_MAX 179 }; 180 181 static const char *const ocelot_function_names[] = { 182 [FUNC_CAN0_a] = "can0_a", 183 [FUNC_CAN0_b] = "can0_b", 184 [FUNC_CAN1] = "can1", 185 [FUNC_CLKMON] = "clkmon", 186 [FUNC_NONE] = "none", 187 [FUNC_FC0_a] = "fc0_a", 188 [FUNC_FC0_b] = "fc0_b", 189 [FUNC_FC0_c] = "fc0_c", 190 [FUNC_FC1_a] = "fc1_a", 191 [FUNC_FC1_b] = "fc1_b", 192 [FUNC_FC1_c] = "fc1_c", 193 [FUNC_FC2_a] = "fc2_a", 194 [FUNC_FC2_b] = "fc2_b", 195 [FUNC_FC3_a] = "fc3_a", 196 [FUNC_FC3_b] = "fc3_b", 197 [FUNC_FC3_c] = "fc3_c", 198 [FUNC_FC4_a] = "fc4_a", 199 [FUNC_FC4_b] = "fc4_b", 200 [FUNC_FC4_c] = "fc4_c", 201 [FUNC_FC_SHRD0] = "fc_shrd0", 202 [FUNC_FC_SHRD1] = "fc_shrd1", 203 [FUNC_FC_SHRD2] = "fc_shrd2", 204 [FUNC_FC_SHRD3] = "fc_shrd3", 205 [FUNC_FC_SHRD4] = "fc_shrd4", 206 [FUNC_FC_SHRD5] = "fc_shrd5", 207 [FUNC_FC_SHRD6] = "fc_shrd6", 208 [FUNC_FC_SHRD7] = "fc_shrd7", 209 [FUNC_FC_SHRD8] = "fc_shrd8", 210 [FUNC_FC_SHRD9] = "fc_shrd9", 211 [FUNC_FC_SHRD10] = "fc_shrd10", 212 [FUNC_FC_SHRD11] = "fc_shrd11", 213 [FUNC_FC_SHRD12] = "fc_shrd12", 214 [FUNC_FC_SHRD13] = "fc_shrd13", 215 [FUNC_FC_SHRD14] = "fc_shrd14", 216 [FUNC_FC_SHRD15] = "fc_shrd15", 217 [FUNC_FC_SHRD16] = "fc_shrd16", 218 [FUNC_FC_SHRD17] = "fc_shrd17", 219 [FUNC_FC_SHRD18] = "fc_shrd18", 220 [FUNC_FC_SHRD19] = "fc_shrd19", 221 [FUNC_FC_SHRD20] = "fc_shrd20", 222 [FUNC_GPIO] = "gpio", 223 [FUNC_IB_TRG_a] = "ib_trig_a", 224 [FUNC_IB_TRG_b] = "ib_trig_b", 225 [FUNC_IB_TRG_c] = "ib_trig_c", 226 [FUNC_IRQ0] = "irq0", 227 [FUNC_IRQ_IN_a] = "irq_in_a", 228 [FUNC_IRQ_IN_b] = "irq_in_b", 229 [FUNC_IRQ_IN_c] = "irq_in_c", 230 [FUNC_IRQ0_IN] = "irq0_in", 231 [FUNC_IRQ_OUT_a] = "irq_out_a", 232 [FUNC_IRQ_OUT_b] = "irq_out_b", 233 [FUNC_IRQ_OUT_c] = "irq_out_c", 234 [FUNC_IRQ0_OUT] = "irq0_out", 235 [FUNC_IRQ1] = "irq1", 236 [FUNC_IRQ1_IN] = "irq1_in", 237 [FUNC_IRQ1_OUT] = "irq1_out", 238 [FUNC_EXT_IRQ] = "ext_irq", 239 [FUNC_MIIM] = "miim", 240 [FUNC_MIIM_a] = "miim_a", 241 [FUNC_MIIM_b] = "miim_b", 242 [FUNC_MIIM_c] = "miim_c", 243 [FUNC_MIIM_Sa] = "miim_slave_a", 244 [FUNC_MIIM_Sb] = "miim_slave_b", 245 [FUNC_PHY_LED] = "phy_led", 246 [FUNC_PCI_WAKE] = "pci_wake", 247 [FUNC_MD] = "md", 248 [FUNC_OB_TRG] = "ob_trig", 249 [FUNC_OB_TRG_a] = "ob_trig_a", 250 [FUNC_OB_TRG_b] = "ob_trig_b", 251 [FUNC_PTP0] = "ptp0", 252 [FUNC_PTP1] = "ptp1", 253 [FUNC_PTP2] = "ptp2", 254 [FUNC_PTP3] = "ptp3", 255 [FUNC_PTPSYNC_0] = "ptpsync_0", 256 [FUNC_PTPSYNC_1] = "ptpsync_1", 257 [FUNC_PTPSYNC_2] = "ptpsync_2", 258 [FUNC_PTPSYNC_3] = "ptpsync_3", 259 [FUNC_PTPSYNC_4] = "ptpsync_4", 260 [FUNC_PTPSYNC_5] = "ptpsync_5", 261 [FUNC_PTPSYNC_6] = "ptpsync_6", 262 [FUNC_PTPSYNC_7] = "ptpsync_7", 263 [FUNC_PWM] = "pwm", 264 [FUNC_PWM_a] = "pwm_a", 265 [FUNC_PWM_b] = "pwm_b", 266 [FUNC_QSPI1] = "qspi1", 267 [FUNC_QSPI2] = "qspi2", 268 [FUNC_R] = "reserved", 269 [FUNC_RECO_a] = "reco_a", 270 [FUNC_RECO_b] = "reco_b", 271 [FUNC_RECO_CLK] = "reco_clk", 272 [FUNC_SD] = "sd", 273 [FUNC_SFP] = "sfp", 274 [FUNC_SFP_SD] = "sfp_sd", 275 [FUNC_SG0] = "sg0", 276 [FUNC_SG1] = "sg1", 277 [FUNC_SG2] = "sg2", 278 [FUNC_SGPIO_a] = "sgpio_a", 279 [FUNC_SGPIO_b] = "sgpio_b", 280 [FUNC_SI] = "si", 281 [FUNC_SI2] = "si2", 282 [FUNC_TACHO] = "tacho", 283 [FUNC_TACHO_a] = "tacho_a", 284 [FUNC_TACHO_b] = "tacho_b", 285 [FUNC_TWI] = "twi", 286 [FUNC_TWI2] = "twi2", 287 [FUNC_TWI3] = "twi3", 288 [FUNC_TWI_SCL_M] = "twi_scl_m", 289 [FUNC_TWI_SLC_GATE] = "twi_slc_gate", 290 [FUNC_TWI_SLC_GATE_AD] = "twi_slc_gate_ad", 291 [FUNC_USB_H_a] = "usb_host_a", 292 [FUNC_USB_H_b] = "usb_host_b", 293 [FUNC_USB_H_c] = "usb_host_c", 294 [FUNC_USB_S_a] = "usb_slave_a", 295 [FUNC_USB_S_b] = "usb_slave_b", 296 [FUNC_USB_S_c] = "usb_slave_c", 297 [FUNC_UART] = "uart", 298 [FUNC_UART2] = "uart2", 299 [FUNC_UART3] = "uart3", 300 [FUNC_PLL_STAT] = "pll_stat", 301 [FUNC_EMMC] = "emmc", 302 [FUNC_EMMC_SD] = "emmc_sd", 303 [FUNC_REF_CLK] = "ref_clk", 304 [FUNC_RCVRD_CLK] = "rcvrd_clk", 305 }; 306 307 struct ocelot_pmx_func { 308 const char **groups; 309 unsigned int ngroups; 310 }; 311 312 struct ocelot_pin_caps { 313 unsigned int pin; 314 unsigned char functions[OCELOT_FUNC_PER_PIN]; 315 unsigned char a_functions[OCELOT_FUNC_PER_PIN]; /* Additional functions */ 316 }; 317 318 struct ocelot_pincfg_data { 319 u8 pd_bit; 320 u8 pu_bit; 321 u8 drive_bits; 322 u8 schmitt_bit; 323 }; 324 325 struct ocelot_pinctrl { 326 struct device *dev; 327 struct pinctrl_dev *pctl; 328 struct gpio_chip gpio_chip; 329 struct regmap *map; 330 struct regmap *pincfg; 331 struct pinctrl_desc *desc; 332 const struct ocelot_pincfg_data *pincfg_data; 333 struct ocelot_pmx_func func[FUNC_MAX]; 334 u8 stride; 335 struct workqueue_struct *wq; 336 }; 337 338 struct ocelot_match_data { 339 struct pinctrl_desc desc; 340 struct ocelot_pincfg_data pincfg_data; 341 }; 342 343 struct ocelot_irq_work { 344 struct work_struct irq_work; 345 struct irq_desc *irq_desc; 346 }; 347 348 #define LUTON_P(p, f0, f1) \ 349 static struct ocelot_pin_caps luton_pin_##p = { \ 350 .pin = p, \ 351 .functions = { \ 352 FUNC_GPIO, FUNC_##f0, FUNC_##f1, FUNC_NONE, \ 353 }, \ 354 } 355 356 LUTON_P(0, SG0, NONE); 357 LUTON_P(1, SG0, NONE); 358 LUTON_P(2, SG0, NONE); 359 LUTON_P(3, SG0, NONE); 360 LUTON_P(4, TACHO, NONE); 361 LUTON_P(5, TWI, PHY_LED); 362 LUTON_P(6, TWI, PHY_LED); 363 LUTON_P(7, NONE, PHY_LED); 364 LUTON_P(8, EXT_IRQ, PHY_LED); 365 LUTON_P(9, EXT_IRQ, PHY_LED); 366 LUTON_P(10, SFP, PHY_LED); 367 LUTON_P(11, SFP, PHY_LED); 368 LUTON_P(12, SFP, PHY_LED); 369 LUTON_P(13, SFP, PHY_LED); 370 LUTON_P(14, SI, PHY_LED); 371 LUTON_P(15, SI, PHY_LED); 372 LUTON_P(16, SI, PHY_LED); 373 LUTON_P(17, SFP, PHY_LED); 374 LUTON_P(18, SFP, PHY_LED); 375 LUTON_P(19, SFP, PHY_LED); 376 LUTON_P(20, SFP, PHY_LED); 377 LUTON_P(21, SFP, PHY_LED); 378 LUTON_P(22, SFP, PHY_LED); 379 LUTON_P(23, SFP, PHY_LED); 380 LUTON_P(24, SFP, PHY_LED); 381 LUTON_P(25, SFP, PHY_LED); 382 LUTON_P(26, SFP, PHY_LED); 383 LUTON_P(27, SFP, PHY_LED); 384 LUTON_P(28, SFP, PHY_LED); 385 LUTON_P(29, PWM, NONE); 386 LUTON_P(30, UART, NONE); 387 LUTON_P(31, UART, NONE); 388 389 #define LUTON_PIN(n) { \ 390 .number = n, \ 391 .name = "GPIO_"#n, \ 392 .drv_data = &luton_pin_##n \ 393 } 394 395 static const struct pinctrl_pin_desc luton_pins[] = { 396 LUTON_PIN(0), 397 LUTON_PIN(1), 398 LUTON_PIN(2), 399 LUTON_PIN(3), 400 LUTON_PIN(4), 401 LUTON_PIN(5), 402 LUTON_PIN(6), 403 LUTON_PIN(7), 404 LUTON_PIN(8), 405 LUTON_PIN(9), 406 LUTON_PIN(10), 407 LUTON_PIN(11), 408 LUTON_PIN(12), 409 LUTON_PIN(13), 410 LUTON_PIN(14), 411 LUTON_PIN(15), 412 LUTON_PIN(16), 413 LUTON_PIN(17), 414 LUTON_PIN(18), 415 LUTON_PIN(19), 416 LUTON_PIN(20), 417 LUTON_PIN(21), 418 LUTON_PIN(22), 419 LUTON_PIN(23), 420 LUTON_PIN(24), 421 LUTON_PIN(25), 422 LUTON_PIN(26), 423 LUTON_PIN(27), 424 LUTON_PIN(28), 425 LUTON_PIN(29), 426 LUTON_PIN(30), 427 LUTON_PIN(31), 428 }; 429 430 #define SERVAL_P(p, f0, f1, f2) \ 431 static struct ocelot_pin_caps serval_pin_##p = { \ 432 .pin = p, \ 433 .functions = { \ 434 FUNC_GPIO, FUNC_##f0, FUNC_##f1, FUNC_##f2, \ 435 }, \ 436 } 437 438 SERVAL_P(0, SG0, NONE, NONE); 439 SERVAL_P(1, SG0, NONE, NONE); 440 SERVAL_P(2, SG0, NONE, NONE); 441 SERVAL_P(3, SG0, NONE, NONE); 442 SERVAL_P(4, TACHO, NONE, NONE); 443 SERVAL_P(5, PWM, NONE, NONE); 444 SERVAL_P(6, TWI, NONE, NONE); 445 SERVAL_P(7, TWI, NONE, NONE); 446 SERVAL_P(8, SI, NONE, NONE); 447 SERVAL_P(9, SI, MD, NONE); 448 SERVAL_P(10, SI, MD, NONE); 449 SERVAL_P(11, SFP, MD, TWI_SCL_M); 450 SERVAL_P(12, SFP, MD, TWI_SCL_M); 451 SERVAL_P(13, SFP, UART2, TWI_SCL_M); 452 SERVAL_P(14, SFP, UART2, TWI_SCL_M); 453 SERVAL_P(15, SFP, PTP0, TWI_SCL_M); 454 SERVAL_P(16, SFP, PTP0, TWI_SCL_M); 455 SERVAL_P(17, SFP, PCI_WAKE, TWI_SCL_M); 456 SERVAL_P(18, SFP, NONE, TWI_SCL_M); 457 SERVAL_P(19, SFP, NONE, TWI_SCL_M); 458 SERVAL_P(20, SFP, NONE, TWI_SCL_M); 459 SERVAL_P(21, SFP, NONE, TWI_SCL_M); 460 SERVAL_P(22, NONE, NONE, NONE); 461 SERVAL_P(23, NONE, NONE, NONE); 462 SERVAL_P(24, NONE, NONE, NONE); 463 SERVAL_P(25, NONE, NONE, NONE); 464 SERVAL_P(26, UART, NONE, NONE); 465 SERVAL_P(27, UART, NONE, NONE); 466 SERVAL_P(28, IRQ0, NONE, NONE); 467 SERVAL_P(29, IRQ1, NONE, NONE); 468 SERVAL_P(30, PTP0, NONE, NONE); 469 SERVAL_P(31, PTP0, NONE, NONE); 470 471 #define SERVAL_PIN(n) { \ 472 .number = n, \ 473 .name = "GPIO_"#n, \ 474 .drv_data = &serval_pin_##n \ 475 } 476 477 static const struct pinctrl_pin_desc serval_pins[] = { 478 SERVAL_PIN(0), 479 SERVAL_PIN(1), 480 SERVAL_PIN(2), 481 SERVAL_PIN(3), 482 SERVAL_PIN(4), 483 SERVAL_PIN(5), 484 SERVAL_PIN(6), 485 SERVAL_PIN(7), 486 SERVAL_PIN(8), 487 SERVAL_PIN(9), 488 SERVAL_PIN(10), 489 SERVAL_PIN(11), 490 SERVAL_PIN(12), 491 SERVAL_PIN(13), 492 SERVAL_PIN(14), 493 SERVAL_PIN(15), 494 SERVAL_PIN(16), 495 SERVAL_PIN(17), 496 SERVAL_PIN(18), 497 SERVAL_PIN(19), 498 SERVAL_PIN(20), 499 SERVAL_PIN(21), 500 SERVAL_PIN(22), 501 SERVAL_PIN(23), 502 SERVAL_PIN(24), 503 SERVAL_PIN(25), 504 SERVAL_PIN(26), 505 SERVAL_PIN(27), 506 SERVAL_PIN(28), 507 SERVAL_PIN(29), 508 SERVAL_PIN(30), 509 SERVAL_PIN(31), 510 }; 511 512 #define OCELOT_P(p, f0, f1, f2) \ 513 static struct ocelot_pin_caps ocelot_pin_##p = { \ 514 .pin = p, \ 515 .functions = { \ 516 FUNC_GPIO, FUNC_##f0, FUNC_##f1, FUNC_##f2, \ 517 }, \ 518 } 519 520 OCELOT_P(0, SG0, NONE, NONE); 521 OCELOT_P(1, SG0, NONE, NONE); 522 OCELOT_P(2, SG0, NONE, NONE); 523 OCELOT_P(3, SG0, NONE, NONE); 524 OCELOT_P(4, IRQ0_IN, IRQ0_OUT, TWI_SCL_M); 525 OCELOT_P(5, IRQ1_IN, IRQ1_OUT, PCI_WAKE); 526 OCELOT_P(6, UART, TWI_SCL_M, NONE); 527 OCELOT_P(7, UART, TWI_SCL_M, NONE); 528 OCELOT_P(8, SI, TWI_SCL_M, IRQ0_OUT); 529 OCELOT_P(9, SI, TWI_SCL_M, IRQ1_OUT); 530 OCELOT_P(10, PTP2, TWI_SCL_M, SFP); 531 OCELOT_P(11, PTP3, TWI_SCL_M, SFP); 532 OCELOT_P(12, UART2, TWI_SCL_M, SFP); 533 OCELOT_P(13, UART2, TWI_SCL_M, SFP); 534 OCELOT_P(14, MIIM, TWI_SCL_M, SFP); 535 OCELOT_P(15, MIIM, TWI_SCL_M, SFP); 536 OCELOT_P(16, TWI, NONE, SI); 537 OCELOT_P(17, TWI, TWI_SCL_M, SI); 538 OCELOT_P(18, PTP0, TWI_SCL_M, NONE); 539 OCELOT_P(19, PTP1, TWI_SCL_M, NONE); 540 OCELOT_P(20, RECO_CLK, TACHO, TWI_SCL_M); 541 OCELOT_P(21, RECO_CLK, PWM, TWI_SCL_M); 542 543 #define OCELOT_PIN(n) { \ 544 .number = n, \ 545 .name = "GPIO_"#n, \ 546 .drv_data = &ocelot_pin_##n \ 547 } 548 549 static const struct pinctrl_pin_desc ocelot_pins[] = { 550 OCELOT_PIN(0), 551 OCELOT_PIN(1), 552 OCELOT_PIN(2), 553 OCELOT_PIN(3), 554 OCELOT_PIN(4), 555 OCELOT_PIN(5), 556 OCELOT_PIN(6), 557 OCELOT_PIN(7), 558 OCELOT_PIN(8), 559 OCELOT_PIN(9), 560 OCELOT_PIN(10), 561 OCELOT_PIN(11), 562 OCELOT_PIN(12), 563 OCELOT_PIN(13), 564 OCELOT_PIN(14), 565 OCELOT_PIN(15), 566 OCELOT_PIN(16), 567 OCELOT_PIN(17), 568 OCELOT_PIN(18), 569 OCELOT_PIN(19), 570 OCELOT_PIN(20), 571 OCELOT_PIN(21), 572 }; 573 574 #define JAGUAR2_P(p, f0, f1) \ 575 static struct ocelot_pin_caps jaguar2_pin_##p = { \ 576 .pin = p, \ 577 .functions = { \ 578 FUNC_GPIO, FUNC_##f0, FUNC_##f1, FUNC_NONE \ 579 }, \ 580 } 581 582 JAGUAR2_P(0, SG0, NONE); 583 JAGUAR2_P(1, SG0, NONE); 584 JAGUAR2_P(2, SG0, NONE); 585 JAGUAR2_P(3, SG0, NONE); 586 JAGUAR2_P(4, SG1, NONE); 587 JAGUAR2_P(5, SG1, NONE); 588 JAGUAR2_P(6, IRQ0_IN, IRQ0_OUT); 589 JAGUAR2_P(7, IRQ1_IN, IRQ1_OUT); 590 JAGUAR2_P(8, PTP0, NONE); 591 JAGUAR2_P(9, PTP1, NONE); 592 JAGUAR2_P(10, UART, NONE); 593 JAGUAR2_P(11, UART, NONE); 594 JAGUAR2_P(12, SG1, NONE); 595 JAGUAR2_P(13, SG1, NONE); 596 JAGUAR2_P(14, TWI, TWI_SCL_M); 597 JAGUAR2_P(15, TWI, NONE); 598 JAGUAR2_P(16, SI, TWI_SCL_M); 599 JAGUAR2_P(17, SI, TWI_SCL_M); 600 JAGUAR2_P(18, SI, TWI_SCL_M); 601 JAGUAR2_P(19, PCI_WAKE, NONE); 602 JAGUAR2_P(20, IRQ0_OUT, TWI_SCL_M); 603 JAGUAR2_P(21, IRQ1_OUT, TWI_SCL_M); 604 JAGUAR2_P(22, TACHO, NONE); 605 JAGUAR2_P(23, PWM, NONE); 606 JAGUAR2_P(24, UART2, NONE); 607 JAGUAR2_P(25, UART2, SI); 608 JAGUAR2_P(26, PTP2, SI); 609 JAGUAR2_P(27, PTP3, SI); 610 JAGUAR2_P(28, TWI2, SI); 611 JAGUAR2_P(29, TWI2, SI); 612 JAGUAR2_P(30, SG2, SI); 613 JAGUAR2_P(31, SG2, SI); 614 JAGUAR2_P(32, SG2, SI); 615 JAGUAR2_P(33, SG2, SI); 616 JAGUAR2_P(34, NONE, TWI_SCL_M); 617 JAGUAR2_P(35, NONE, TWI_SCL_M); 618 JAGUAR2_P(36, NONE, TWI_SCL_M); 619 JAGUAR2_P(37, NONE, TWI_SCL_M); 620 JAGUAR2_P(38, NONE, TWI_SCL_M); 621 JAGUAR2_P(39, NONE, TWI_SCL_M); 622 JAGUAR2_P(40, NONE, TWI_SCL_M); 623 JAGUAR2_P(41, NONE, TWI_SCL_M); 624 JAGUAR2_P(42, NONE, TWI_SCL_M); 625 JAGUAR2_P(43, NONE, TWI_SCL_M); 626 JAGUAR2_P(44, NONE, SFP); 627 JAGUAR2_P(45, NONE, SFP); 628 JAGUAR2_P(46, NONE, SFP); 629 JAGUAR2_P(47, NONE, SFP); 630 JAGUAR2_P(48, SFP, NONE); 631 JAGUAR2_P(49, SFP, SI); 632 JAGUAR2_P(50, SFP, SI); 633 JAGUAR2_P(51, SFP, SI); 634 JAGUAR2_P(52, SFP, NONE); 635 JAGUAR2_P(53, SFP, NONE); 636 JAGUAR2_P(54, SFP, NONE); 637 JAGUAR2_P(55, SFP, NONE); 638 JAGUAR2_P(56, MIIM, SFP); 639 JAGUAR2_P(57, MIIM, SFP); 640 JAGUAR2_P(58, MIIM, SFP); 641 JAGUAR2_P(59, MIIM, SFP); 642 JAGUAR2_P(60, NONE, NONE); 643 JAGUAR2_P(61, NONE, NONE); 644 JAGUAR2_P(62, NONE, NONE); 645 JAGUAR2_P(63, NONE, NONE); 646 647 #define JAGUAR2_PIN(n) { \ 648 .number = n, \ 649 .name = "GPIO_"#n, \ 650 .drv_data = &jaguar2_pin_##n \ 651 } 652 653 static const struct pinctrl_pin_desc jaguar2_pins[] = { 654 JAGUAR2_PIN(0), 655 JAGUAR2_PIN(1), 656 JAGUAR2_PIN(2), 657 JAGUAR2_PIN(3), 658 JAGUAR2_PIN(4), 659 JAGUAR2_PIN(5), 660 JAGUAR2_PIN(6), 661 JAGUAR2_PIN(7), 662 JAGUAR2_PIN(8), 663 JAGUAR2_PIN(9), 664 JAGUAR2_PIN(10), 665 JAGUAR2_PIN(11), 666 JAGUAR2_PIN(12), 667 JAGUAR2_PIN(13), 668 JAGUAR2_PIN(14), 669 JAGUAR2_PIN(15), 670 JAGUAR2_PIN(16), 671 JAGUAR2_PIN(17), 672 JAGUAR2_PIN(18), 673 JAGUAR2_PIN(19), 674 JAGUAR2_PIN(20), 675 JAGUAR2_PIN(21), 676 JAGUAR2_PIN(22), 677 JAGUAR2_PIN(23), 678 JAGUAR2_PIN(24), 679 JAGUAR2_PIN(25), 680 JAGUAR2_PIN(26), 681 JAGUAR2_PIN(27), 682 JAGUAR2_PIN(28), 683 JAGUAR2_PIN(29), 684 JAGUAR2_PIN(30), 685 JAGUAR2_PIN(31), 686 JAGUAR2_PIN(32), 687 JAGUAR2_PIN(33), 688 JAGUAR2_PIN(34), 689 JAGUAR2_PIN(35), 690 JAGUAR2_PIN(36), 691 JAGUAR2_PIN(37), 692 JAGUAR2_PIN(38), 693 JAGUAR2_PIN(39), 694 JAGUAR2_PIN(40), 695 JAGUAR2_PIN(41), 696 JAGUAR2_PIN(42), 697 JAGUAR2_PIN(43), 698 JAGUAR2_PIN(44), 699 JAGUAR2_PIN(45), 700 JAGUAR2_PIN(46), 701 JAGUAR2_PIN(47), 702 JAGUAR2_PIN(48), 703 JAGUAR2_PIN(49), 704 JAGUAR2_PIN(50), 705 JAGUAR2_PIN(51), 706 JAGUAR2_PIN(52), 707 JAGUAR2_PIN(53), 708 JAGUAR2_PIN(54), 709 JAGUAR2_PIN(55), 710 JAGUAR2_PIN(56), 711 JAGUAR2_PIN(57), 712 JAGUAR2_PIN(58), 713 JAGUAR2_PIN(59), 714 JAGUAR2_PIN(60), 715 JAGUAR2_PIN(61), 716 JAGUAR2_PIN(62), 717 JAGUAR2_PIN(63), 718 }; 719 720 #define SERVALT_P(p, f0, f1, f2) \ 721 static struct ocelot_pin_caps servalt_pin_##p = { \ 722 .pin = p, \ 723 .functions = { \ 724 FUNC_GPIO, FUNC_##f0, FUNC_##f1, FUNC_##f2 \ 725 }, \ 726 } 727 728 SERVALT_P(0, SG0, NONE, NONE); 729 SERVALT_P(1, SG0, NONE, NONE); 730 SERVALT_P(2, SG0, NONE, NONE); 731 SERVALT_P(3, SG0, NONE, NONE); 732 SERVALT_P(4, IRQ0_IN, IRQ0_OUT, TWI_SCL_M); 733 SERVALT_P(5, IRQ1_IN, IRQ1_OUT, TWI_SCL_M); 734 SERVALT_P(6, UART, NONE, NONE); 735 SERVALT_P(7, UART, NONE, NONE); 736 SERVALT_P(8, SI, SFP, TWI_SCL_M); 737 SERVALT_P(9, PCI_WAKE, SFP, SI); 738 SERVALT_P(10, PTP0, SFP, TWI_SCL_M); 739 SERVALT_P(11, PTP1, SFP, TWI_SCL_M); 740 SERVALT_P(12, REF_CLK, SFP, TWI_SCL_M); 741 SERVALT_P(13, REF_CLK, SFP, TWI_SCL_M); 742 SERVALT_P(14, REF_CLK, IRQ0_OUT, SI); 743 SERVALT_P(15, REF_CLK, IRQ1_OUT, SI); 744 SERVALT_P(16, TACHO, SFP, SI); 745 SERVALT_P(17, PWM, NONE, TWI_SCL_M); 746 SERVALT_P(18, PTP2, SFP, SI); 747 SERVALT_P(19, PTP3, SFP, SI); 748 SERVALT_P(20, UART2, SFP, SI); 749 SERVALT_P(21, UART2, NONE, NONE); 750 SERVALT_P(22, MIIM, SFP, TWI2); 751 SERVALT_P(23, MIIM, SFP, TWI2); 752 SERVALT_P(24, TWI, NONE, NONE); 753 SERVALT_P(25, TWI, SFP, TWI_SCL_M); 754 SERVALT_P(26, TWI_SCL_M, SFP, SI); 755 SERVALT_P(27, TWI_SCL_M, SFP, SI); 756 SERVALT_P(28, TWI_SCL_M, SFP, SI); 757 SERVALT_P(29, TWI_SCL_M, NONE, NONE); 758 SERVALT_P(30, TWI_SCL_M, NONE, NONE); 759 SERVALT_P(31, TWI_SCL_M, NONE, NONE); 760 SERVALT_P(32, TWI_SCL_M, NONE, NONE); 761 SERVALT_P(33, RCVRD_CLK, NONE, NONE); 762 SERVALT_P(34, RCVRD_CLK, NONE, NONE); 763 SERVALT_P(35, RCVRD_CLK, NONE, NONE); 764 SERVALT_P(36, RCVRD_CLK, NONE, NONE); 765 766 #define SERVALT_PIN(n) { \ 767 .number = n, \ 768 .name = "GPIO_"#n, \ 769 .drv_data = &servalt_pin_##n \ 770 } 771 772 static const struct pinctrl_pin_desc servalt_pins[] = { 773 SERVALT_PIN(0), 774 SERVALT_PIN(1), 775 SERVALT_PIN(2), 776 SERVALT_PIN(3), 777 SERVALT_PIN(4), 778 SERVALT_PIN(5), 779 SERVALT_PIN(6), 780 SERVALT_PIN(7), 781 SERVALT_PIN(8), 782 SERVALT_PIN(9), 783 SERVALT_PIN(10), 784 SERVALT_PIN(11), 785 SERVALT_PIN(12), 786 SERVALT_PIN(13), 787 SERVALT_PIN(14), 788 SERVALT_PIN(15), 789 SERVALT_PIN(16), 790 SERVALT_PIN(17), 791 SERVALT_PIN(18), 792 SERVALT_PIN(19), 793 SERVALT_PIN(20), 794 SERVALT_PIN(21), 795 SERVALT_PIN(22), 796 SERVALT_PIN(23), 797 SERVALT_PIN(24), 798 SERVALT_PIN(25), 799 SERVALT_PIN(26), 800 SERVALT_PIN(27), 801 SERVALT_PIN(28), 802 SERVALT_PIN(29), 803 SERVALT_PIN(30), 804 SERVALT_PIN(31), 805 SERVALT_PIN(32), 806 SERVALT_PIN(33), 807 SERVALT_PIN(34), 808 SERVALT_PIN(35), 809 SERVALT_PIN(36), 810 }; 811 812 #define SPARX5_P(p, f0, f1, f2) \ 813 static struct ocelot_pin_caps sparx5_pin_##p = { \ 814 .pin = p, \ 815 .functions = { \ 816 FUNC_GPIO, FUNC_##f0, FUNC_##f1, FUNC_##f2 \ 817 }, \ 818 } 819 820 SPARX5_P(0, SG0, PLL_STAT, NONE); 821 SPARX5_P(1, SG0, NONE, NONE); 822 SPARX5_P(2, SG0, NONE, NONE); 823 SPARX5_P(3, SG0, NONE, NONE); 824 SPARX5_P(4, SG1, NONE, NONE); 825 SPARX5_P(5, SG1, NONE, NONE); 826 SPARX5_P(6, IRQ0_IN, IRQ0_OUT, SFP); 827 SPARX5_P(7, IRQ1_IN, IRQ1_OUT, SFP); 828 SPARX5_P(8, PTP0, NONE, SFP); 829 SPARX5_P(9, PTP1, SFP, TWI_SCL_M); 830 SPARX5_P(10, UART, NONE, NONE); 831 SPARX5_P(11, UART, NONE, NONE); 832 SPARX5_P(12, SG1, NONE, NONE); 833 SPARX5_P(13, SG1, NONE, NONE); 834 SPARX5_P(14, TWI, TWI_SCL_M, NONE); 835 SPARX5_P(15, TWI, NONE, NONE); 836 SPARX5_P(16, SI, TWI_SCL_M, SFP); 837 SPARX5_P(17, SI, TWI_SCL_M, SFP); 838 SPARX5_P(18, SI, TWI_SCL_M, SFP); 839 SPARX5_P(19, PCI_WAKE, TWI_SCL_M, SFP); 840 SPARX5_P(20, IRQ0_OUT, TWI_SCL_M, SFP); 841 SPARX5_P(21, IRQ1_OUT, TACHO, SFP); 842 SPARX5_P(22, TACHO, IRQ0_OUT, TWI_SCL_M); 843 SPARX5_P(23, PWM, UART3, TWI_SCL_M); 844 SPARX5_P(24, PTP2, UART3, TWI_SCL_M); 845 SPARX5_P(25, PTP3, SI, TWI_SCL_M); 846 SPARX5_P(26, UART2, SI, TWI_SCL_M); 847 SPARX5_P(27, UART2, SI, TWI_SCL_M); 848 SPARX5_P(28, TWI2, SI, SFP); 849 SPARX5_P(29, TWI2, SI, SFP); 850 SPARX5_P(30, SG2, SI, PWM); 851 SPARX5_P(31, SG2, SI, TWI_SCL_M); 852 SPARX5_P(32, SG2, SI, TWI_SCL_M); 853 SPARX5_P(33, SG2, SI, SFP); 854 SPARX5_P(34, NONE, TWI_SCL_M, EMMC); 855 SPARX5_P(35, SFP, TWI_SCL_M, EMMC); 856 SPARX5_P(36, SFP, TWI_SCL_M, EMMC); 857 SPARX5_P(37, SFP, NONE, EMMC); 858 SPARX5_P(38, NONE, TWI_SCL_M, EMMC); 859 SPARX5_P(39, SI2, TWI_SCL_M, EMMC); 860 SPARX5_P(40, SI2, TWI_SCL_M, EMMC); 861 SPARX5_P(41, SI2, TWI_SCL_M, EMMC); 862 SPARX5_P(42, SI2, TWI_SCL_M, EMMC); 863 SPARX5_P(43, SI2, TWI_SCL_M, EMMC); 864 SPARX5_P(44, SI, SFP, EMMC); 865 SPARX5_P(45, SI, SFP, EMMC); 866 SPARX5_P(46, NONE, SFP, EMMC); 867 SPARX5_P(47, NONE, SFP, EMMC); 868 SPARX5_P(48, TWI3, SI, SFP); 869 SPARX5_P(49, TWI3, NONE, SFP); 870 SPARX5_P(50, SFP, NONE, TWI_SCL_M); 871 SPARX5_P(51, SFP, SI, TWI_SCL_M); 872 SPARX5_P(52, SFP, MIIM, TWI_SCL_M); 873 SPARX5_P(53, SFP, MIIM, TWI_SCL_M); 874 SPARX5_P(54, SFP, PTP2, TWI_SCL_M); 875 SPARX5_P(55, SFP, PTP3, PCI_WAKE); 876 SPARX5_P(56, MIIM, SFP, TWI_SCL_M); 877 SPARX5_P(57, MIIM, SFP, TWI_SCL_M); 878 SPARX5_P(58, MIIM, SFP, TWI_SCL_M); 879 SPARX5_P(59, MIIM, SFP, NONE); 880 SPARX5_P(60, RECO_CLK, NONE, NONE); 881 SPARX5_P(61, RECO_CLK, NONE, NONE); 882 SPARX5_P(62, RECO_CLK, PLL_STAT, NONE); 883 SPARX5_P(63, RECO_CLK, NONE, NONE); 884 885 #define SPARX5_PIN(n) { \ 886 .number = n, \ 887 .name = "GPIO_"#n, \ 888 .drv_data = &sparx5_pin_##n \ 889 } 890 891 static const struct pinctrl_pin_desc sparx5_pins[] = { 892 SPARX5_PIN(0), 893 SPARX5_PIN(1), 894 SPARX5_PIN(2), 895 SPARX5_PIN(3), 896 SPARX5_PIN(4), 897 SPARX5_PIN(5), 898 SPARX5_PIN(6), 899 SPARX5_PIN(7), 900 SPARX5_PIN(8), 901 SPARX5_PIN(9), 902 SPARX5_PIN(10), 903 SPARX5_PIN(11), 904 SPARX5_PIN(12), 905 SPARX5_PIN(13), 906 SPARX5_PIN(14), 907 SPARX5_PIN(15), 908 SPARX5_PIN(16), 909 SPARX5_PIN(17), 910 SPARX5_PIN(18), 911 SPARX5_PIN(19), 912 SPARX5_PIN(20), 913 SPARX5_PIN(21), 914 SPARX5_PIN(22), 915 SPARX5_PIN(23), 916 SPARX5_PIN(24), 917 SPARX5_PIN(25), 918 SPARX5_PIN(26), 919 SPARX5_PIN(27), 920 SPARX5_PIN(28), 921 SPARX5_PIN(29), 922 SPARX5_PIN(30), 923 SPARX5_PIN(31), 924 SPARX5_PIN(32), 925 SPARX5_PIN(33), 926 SPARX5_PIN(34), 927 SPARX5_PIN(35), 928 SPARX5_PIN(36), 929 SPARX5_PIN(37), 930 SPARX5_PIN(38), 931 SPARX5_PIN(39), 932 SPARX5_PIN(40), 933 SPARX5_PIN(41), 934 SPARX5_PIN(42), 935 SPARX5_PIN(43), 936 SPARX5_PIN(44), 937 SPARX5_PIN(45), 938 SPARX5_PIN(46), 939 SPARX5_PIN(47), 940 SPARX5_PIN(48), 941 SPARX5_PIN(49), 942 SPARX5_PIN(50), 943 SPARX5_PIN(51), 944 SPARX5_PIN(52), 945 SPARX5_PIN(53), 946 SPARX5_PIN(54), 947 SPARX5_PIN(55), 948 SPARX5_PIN(56), 949 SPARX5_PIN(57), 950 SPARX5_PIN(58), 951 SPARX5_PIN(59), 952 SPARX5_PIN(60), 953 SPARX5_PIN(61), 954 SPARX5_PIN(62), 955 SPARX5_PIN(63), 956 }; 957 958 #define LAN966X_P(p, f0, f1, f2, f3, f4, f5, f6, f7) \ 959 static struct ocelot_pin_caps lan966x_pin_##p = { \ 960 .pin = p, \ 961 .functions = { \ 962 FUNC_##f0, FUNC_##f1, FUNC_##f2, \ 963 FUNC_##f3 \ 964 }, \ 965 .a_functions = { \ 966 FUNC_##f4, FUNC_##f5, FUNC_##f6, \ 967 FUNC_##f7 \ 968 }, \ 969 } 970 971 /* Pinmuxing table taken from data sheet */ 972 /* Pin FUNC0 FUNC1 FUNC2 FUNC3 FUNC4 FUNC5 FUNC6 FUNC7 */ 973 LAN966X_P(0, GPIO, NONE, NONE, NONE, NONE, NONE, NONE, R); 974 LAN966X_P(1, GPIO, NONE, NONE, NONE, NONE, NONE, NONE, R); 975 LAN966X_P(2, GPIO, NONE, NONE, NONE, NONE, NONE, NONE, R); 976 LAN966X_P(3, GPIO, NONE, NONE, NONE, NONE, NONE, NONE, R); 977 LAN966X_P(4, GPIO, NONE, NONE, NONE, NONE, NONE, NONE, R); 978 LAN966X_P(5, GPIO, NONE, NONE, NONE, NONE, NONE, NONE, R); 979 LAN966X_P(6, GPIO, NONE, NONE, NONE, NONE, NONE, NONE, R); 980 LAN966X_P(7, GPIO, NONE, NONE, NONE, NONE, NONE, NONE, R); 981 LAN966X_P(8, GPIO, FC0_a, USB_H_b, NONE, USB_S_b, NONE, NONE, R); 982 LAN966X_P(9, GPIO, FC0_a, USB_H_b, NONE, NONE, NONE, NONE, R); 983 LAN966X_P(10, GPIO, FC0_a, NONE, NONE, NONE, NONE, NONE, R); 984 LAN966X_P(11, GPIO, FC1_a, NONE, NONE, NONE, NONE, NONE, R); 985 LAN966X_P(12, GPIO, FC1_a, NONE, NONE, NONE, NONE, NONE, R); 986 LAN966X_P(13, GPIO, FC1_a, NONE, NONE, NONE, NONE, NONE, R); 987 LAN966X_P(14, GPIO, FC2_a, NONE, NONE, NONE, NONE, NONE, R); 988 LAN966X_P(15, GPIO, FC2_a, NONE, NONE, NONE, NONE, NONE, R); 989 LAN966X_P(16, GPIO, FC2_a, IB_TRG_a, NONE, OB_TRG_a, IRQ_IN_c, IRQ_OUT_c, R); 990 LAN966X_P(17, GPIO, FC3_a, IB_TRG_a, NONE, OB_TRG_a, IRQ_IN_c, IRQ_OUT_c, R); 991 LAN966X_P(18, GPIO, FC3_a, IB_TRG_a, NONE, OB_TRG_a, IRQ_IN_c, IRQ_OUT_c, R); 992 LAN966X_P(19, GPIO, FC3_a, IB_TRG_a, NONE, OB_TRG_a, IRQ_IN_c, IRQ_OUT_c, R); 993 LAN966X_P(20, GPIO, FC4_a, IB_TRG_a, NONE, OB_TRG_a, IRQ_IN_c, NONE, R); 994 LAN966X_P(21, GPIO, FC4_a, NONE, NONE, OB_TRG_a, NONE, NONE, R); 995 LAN966X_P(22, GPIO, FC4_a, NONE, NONE, OB_TRG_a, NONE, NONE, R); 996 LAN966X_P(23, GPIO, NONE, NONE, NONE, OB_TRG_a, NONE, NONE, R); 997 LAN966X_P(24, GPIO, FC0_b, IB_TRG_a, USB_H_c, OB_TRG_a, IRQ_IN_c, TACHO_a, R); 998 LAN966X_P(25, GPIO, FC0_b, IB_TRG_a, USB_H_c, OB_TRG_a, IRQ_OUT_c, SFP_SD, R); 999 LAN966X_P(26, GPIO, FC0_b, IB_TRG_a, USB_S_c, OB_TRG_a, CAN0_a, SFP_SD, R); 1000 LAN966X_P(27, GPIO, NONE, NONE, NONE, OB_TRG_a, CAN0_a, PWM_a, R); 1001 LAN966X_P(28, GPIO, MIIM_a, NONE, NONE, OB_TRG_a, IRQ_OUT_c, SFP_SD, R); 1002 LAN966X_P(29, GPIO, MIIM_a, NONE, NONE, OB_TRG_a, NONE, NONE, R); 1003 LAN966X_P(30, GPIO, FC3_c, CAN1, CLKMON, OB_TRG, RECO_b, NONE, R); 1004 LAN966X_P(31, GPIO, FC3_c, CAN1, CLKMON, OB_TRG, RECO_b, NONE, R); 1005 LAN966X_P(32, GPIO, FC3_c, NONE, SGPIO_a, NONE, MIIM_Sa, NONE, R); 1006 LAN966X_P(33, GPIO, FC1_b, NONE, SGPIO_a, NONE, MIIM_Sa, MIIM_b, R); 1007 LAN966X_P(34, GPIO, FC1_b, NONE, SGPIO_a, NONE, MIIM_Sa, MIIM_b, R); 1008 LAN966X_P(35, GPIO, FC1_b, PTPSYNC_0, SGPIO_a, CAN0_b, NONE, NONE, R); 1009 LAN966X_P(36, GPIO, NONE, PTPSYNC_1, NONE, CAN0_b, NONE, NONE, R); 1010 LAN966X_P(37, GPIO, FC_SHRD0, PTPSYNC_2, TWI_SLC_GATE_AD, NONE, NONE, NONE, R); 1011 LAN966X_P(38, GPIO, NONE, PTPSYNC_3, NONE, NONE, NONE, NONE, R); 1012 LAN966X_P(39, GPIO, NONE, PTPSYNC_4, NONE, NONE, NONE, NONE, R); 1013 LAN966X_P(40, GPIO, FC_SHRD1, PTPSYNC_5, NONE, NONE, NONE, NONE, R); 1014 LAN966X_P(41, GPIO, FC_SHRD2, PTPSYNC_6, TWI_SLC_GATE_AD, NONE, NONE, NONE, R); 1015 LAN966X_P(42, GPIO, FC_SHRD3, PTPSYNC_7, TWI_SLC_GATE_AD, NONE, NONE, NONE, R); 1016 LAN966X_P(43, GPIO, FC2_b, OB_TRG_b, IB_TRG_b, IRQ_OUT_a, RECO_a, IRQ_IN_a, R); 1017 LAN966X_P(44, GPIO, FC2_b, OB_TRG_b, IB_TRG_b, IRQ_OUT_a, RECO_a, IRQ_IN_a, R); 1018 LAN966X_P(45, GPIO, FC2_b, OB_TRG_b, IB_TRG_b, IRQ_OUT_a, NONE, IRQ_IN_a, R); 1019 LAN966X_P(46, GPIO, FC1_c, OB_TRG_b, IB_TRG_b, IRQ_OUT_a, FC_SHRD4, IRQ_IN_a, R); 1020 LAN966X_P(47, GPIO, FC1_c, OB_TRG_b, IB_TRG_b, IRQ_OUT_a, FC_SHRD5, IRQ_IN_a, R); 1021 LAN966X_P(48, GPIO, FC1_c, OB_TRG_b, IB_TRG_b, IRQ_OUT_a, FC_SHRD6, IRQ_IN_a, R); 1022 LAN966X_P(49, GPIO, FC_SHRD7, OB_TRG_b, IB_TRG_b, IRQ_OUT_a, TWI_SLC_GATE, IRQ_IN_a, R); 1023 LAN966X_P(50, GPIO, FC_SHRD16, OB_TRG_b, IB_TRG_b, IRQ_OUT_a, TWI_SLC_GATE, NONE, R); 1024 LAN966X_P(51, GPIO, FC3_b, OB_TRG_b, IB_TRG_c, IRQ_OUT_b, PWM_b, IRQ_IN_b, R); 1025 LAN966X_P(52, GPIO, FC3_b, OB_TRG_b, IB_TRG_c, IRQ_OUT_b, TACHO_b, IRQ_IN_b, R); 1026 LAN966X_P(53, GPIO, FC3_b, OB_TRG_b, IB_TRG_c, IRQ_OUT_b, NONE, IRQ_IN_b, R); 1027 LAN966X_P(54, GPIO, FC_SHRD8, OB_TRG_b, IB_TRG_c, IRQ_OUT_b, TWI_SLC_GATE, IRQ_IN_b, R); 1028 LAN966X_P(55, GPIO, FC_SHRD9, OB_TRG_b, IB_TRG_c, IRQ_OUT_b, TWI_SLC_GATE, IRQ_IN_b, R); 1029 LAN966X_P(56, GPIO, FC4_b, OB_TRG_b, IB_TRG_c, IRQ_OUT_b, FC_SHRD10, IRQ_IN_b, R); 1030 LAN966X_P(57, GPIO, FC4_b, TWI_SLC_GATE, IB_TRG_c, IRQ_OUT_b, FC_SHRD11, IRQ_IN_b, R); 1031 LAN966X_P(58, GPIO, FC4_b, TWI_SLC_GATE, IB_TRG_c, IRQ_OUT_b, FC_SHRD12, IRQ_IN_b, R); 1032 LAN966X_P(59, GPIO, QSPI1, MIIM_c, NONE, NONE, MIIM_Sb, NONE, R); 1033 LAN966X_P(60, GPIO, QSPI1, MIIM_c, NONE, NONE, MIIM_Sb, NONE, R); 1034 LAN966X_P(61, GPIO, QSPI1, NONE, SGPIO_b, FC0_c, MIIM_Sb, NONE, R); 1035 LAN966X_P(62, GPIO, QSPI1, FC_SHRD13, SGPIO_b, FC0_c, TWI_SLC_GATE, SFP_SD, R); 1036 LAN966X_P(63, GPIO, QSPI1, FC_SHRD14, SGPIO_b, FC0_c, TWI_SLC_GATE, SFP_SD, R); 1037 LAN966X_P(64, GPIO, QSPI1, FC4_c, SGPIO_b, FC_SHRD15, TWI_SLC_GATE, SFP_SD, R); 1038 LAN966X_P(65, GPIO, USB_H_a, FC4_c, NONE, IRQ_OUT_c, TWI_SLC_GATE_AD, NONE, R); 1039 LAN966X_P(66, GPIO, USB_H_a, FC4_c, USB_S_a, IRQ_OUT_c, IRQ_IN_c, NONE, R); 1040 LAN966X_P(67, GPIO, EMMC_SD, NONE, QSPI2, NONE, NONE, NONE, R); 1041 LAN966X_P(68, GPIO, EMMC_SD, NONE, QSPI2, NONE, NONE, NONE, R); 1042 LAN966X_P(69, GPIO, EMMC_SD, NONE, QSPI2, NONE, NONE, NONE, R); 1043 LAN966X_P(70, GPIO, EMMC_SD, NONE, QSPI2, NONE, NONE, NONE, R); 1044 LAN966X_P(71, GPIO, EMMC_SD, NONE, QSPI2, NONE, NONE, NONE, R); 1045 LAN966X_P(72, GPIO, EMMC_SD, NONE, QSPI2, NONE, NONE, NONE, R); 1046 LAN966X_P(73, GPIO, EMMC, NONE, NONE, SD, NONE, NONE, R); 1047 LAN966X_P(74, GPIO, EMMC, NONE, FC_SHRD17, SD, TWI_SLC_GATE, NONE, R); 1048 LAN966X_P(75, GPIO, EMMC, NONE, FC_SHRD18, SD, TWI_SLC_GATE, NONE, R); 1049 LAN966X_P(76, GPIO, EMMC, NONE, FC_SHRD19, SD, TWI_SLC_GATE, NONE, R); 1050 LAN966X_P(77, GPIO, EMMC_SD, NONE, FC_SHRD20, NONE, TWI_SLC_GATE, NONE, R); 1051 1052 #define LAN966X_PIN(n) { \ 1053 .number = n, \ 1054 .name = "GPIO_"#n, \ 1055 .drv_data = &lan966x_pin_##n \ 1056 } 1057 1058 static const struct pinctrl_pin_desc lan966x_pins[] = { 1059 LAN966X_PIN(0), 1060 LAN966X_PIN(1), 1061 LAN966X_PIN(2), 1062 LAN966X_PIN(3), 1063 LAN966X_PIN(4), 1064 LAN966X_PIN(5), 1065 LAN966X_PIN(6), 1066 LAN966X_PIN(7), 1067 LAN966X_PIN(8), 1068 LAN966X_PIN(9), 1069 LAN966X_PIN(10), 1070 LAN966X_PIN(11), 1071 LAN966X_PIN(12), 1072 LAN966X_PIN(13), 1073 LAN966X_PIN(14), 1074 LAN966X_PIN(15), 1075 LAN966X_PIN(16), 1076 LAN966X_PIN(17), 1077 LAN966X_PIN(18), 1078 LAN966X_PIN(19), 1079 LAN966X_PIN(20), 1080 LAN966X_PIN(21), 1081 LAN966X_PIN(22), 1082 LAN966X_PIN(23), 1083 LAN966X_PIN(24), 1084 LAN966X_PIN(25), 1085 LAN966X_PIN(26), 1086 LAN966X_PIN(27), 1087 LAN966X_PIN(28), 1088 LAN966X_PIN(29), 1089 LAN966X_PIN(30), 1090 LAN966X_PIN(31), 1091 LAN966X_PIN(32), 1092 LAN966X_PIN(33), 1093 LAN966X_PIN(34), 1094 LAN966X_PIN(35), 1095 LAN966X_PIN(36), 1096 LAN966X_PIN(37), 1097 LAN966X_PIN(38), 1098 LAN966X_PIN(39), 1099 LAN966X_PIN(40), 1100 LAN966X_PIN(41), 1101 LAN966X_PIN(42), 1102 LAN966X_PIN(43), 1103 LAN966X_PIN(44), 1104 LAN966X_PIN(45), 1105 LAN966X_PIN(46), 1106 LAN966X_PIN(47), 1107 LAN966X_PIN(48), 1108 LAN966X_PIN(49), 1109 LAN966X_PIN(50), 1110 LAN966X_PIN(51), 1111 LAN966X_PIN(52), 1112 LAN966X_PIN(53), 1113 LAN966X_PIN(54), 1114 LAN966X_PIN(55), 1115 LAN966X_PIN(56), 1116 LAN966X_PIN(57), 1117 LAN966X_PIN(58), 1118 LAN966X_PIN(59), 1119 LAN966X_PIN(60), 1120 LAN966X_PIN(61), 1121 LAN966X_PIN(62), 1122 LAN966X_PIN(63), 1123 LAN966X_PIN(64), 1124 LAN966X_PIN(65), 1125 LAN966X_PIN(66), 1126 LAN966X_PIN(67), 1127 LAN966X_PIN(68), 1128 LAN966X_PIN(69), 1129 LAN966X_PIN(70), 1130 LAN966X_PIN(71), 1131 LAN966X_PIN(72), 1132 LAN966X_PIN(73), 1133 LAN966X_PIN(74), 1134 LAN966X_PIN(75), 1135 LAN966X_PIN(76), 1136 LAN966X_PIN(77), 1137 }; 1138 1139 static int ocelot_get_functions_count(struct pinctrl_dev *pctldev) 1140 { 1141 return ARRAY_SIZE(ocelot_function_names); 1142 } 1143 1144 static const char *ocelot_get_function_name(struct pinctrl_dev *pctldev, 1145 unsigned int function) 1146 { 1147 return ocelot_function_names[function]; 1148 } 1149 1150 static int ocelot_get_function_groups(struct pinctrl_dev *pctldev, 1151 unsigned int function, 1152 const char *const **groups, 1153 unsigned *const num_groups) 1154 { 1155 struct ocelot_pinctrl *info = pinctrl_dev_get_drvdata(pctldev); 1156 1157 *groups = info->func[function].groups; 1158 *num_groups = info->func[function].ngroups; 1159 1160 return 0; 1161 } 1162 1163 static int ocelot_pin_function_idx(struct ocelot_pinctrl *info, 1164 unsigned int pin, unsigned int function) 1165 { 1166 struct ocelot_pin_caps *p = info->desc->pins[pin].drv_data; 1167 int i; 1168 1169 for (i = 0; i < OCELOT_FUNC_PER_PIN; i++) { 1170 if (function == p->functions[i]) 1171 return i; 1172 1173 if (function == p->a_functions[i]) 1174 return i + OCELOT_FUNC_PER_PIN; 1175 } 1176 1177 return -1; 1178 } 1179 1180 #define REG_ALT(msb, info, p) (OCELOT_GPIO_ALT0 * (info)->stride + 4 * ((msb) + ((info)->stride * ((p) / 32)))) 1181 1182 static int ocelot_pinmux_set_mux(struct pinctrl_dev *pctldev, 1183 unsigned int selector, unsigned int group) 1184 { 1185 struct ocelot_pinctrl *info = pinctrl_dev_get_drvdata(pctldev); 1186 struct ocelot_pin_caps *pin = info->desc->pins[group].drv_data; 1187 unsigned int p = pin->pin % 32; 1188 int f; 1189 1190 f = ocelot_pin_function_idx(info, group, selector); 1191 if (f < 0) 1192 return -EINVAL; 1193 1194 /* 1195 * f is encoded on two bits. 1196 * bit 0 of f goes in BIT(pin) of ALT[0], bit 1 of f goes in BIT(pin) of 1197 * ALT[1] 1198 * This is racy because both registers can't be updated at the same time 1199 * but it doesn't matter much for now. 1200 * Note: ALT0/ALT1 are organized specially for 64 gpio targets 1201 */ 1202 regmap_update_bits(info->map, REG_ALT(0, info, pin->pin), 1203 BIT(p), f << p); 1204 regmap_update_bits(info->map, REG_ALT(1, info, pin->pin), 1205 BIT(p), (f >> 1) << p); 1206 1207 return 0; 1208 } 1209 1210 static int lan966x_pinmux_set_mux(struct pinctrl_dev *pctldev, 1211 unsigned int selector, unsigned int group) 1212 { 1213 struct ocelot_pinctrl *info = pinctrl_dev_get_drvdata(pctldev); 1214 struct ocelot_pin_caps *pin = info->desc->pins[group].drv_data; 1215 unsigned int p = pin->pin % 32; 1216 int f; 1217 1218 f = ocelot_pin_function_idx(info, group, selector); 1219 if (f < 0) 1220 return -EINVAL; 1221 1222 /* 1223 * f is encoded on three bits. 1224 * bit 0 of f goes in BIT(pin) of ALT[0], bit 1 of f goes in BIT(pin) of 1225 * ALT[1], bit 2 of f goes in BIT(pin) of ALT[2] 1226 * This is racy because three registers can't be updated at the same time 1227 * but it doesn't matter much for now. 1228 * Note: ALT0/ALT1/ALT2 are organized specially for 78 gpio targets 1229 */ 1230 regmap_update_bits(info->map, REG_ALT(0, info, pin->pin), 1231 BIT(p), f << p); 1232 regmap_update_bits(info->map, REG_ALT(1, info, pin->pin), 1233 BIT(p), (f >> 1) << p); 1234 regmap_update_bits(info->map, REG_ALT(2, info, pin->pin), 1235 BIT(p), (f >> 2) << p); 1236 1237 return 0; 1238 } 1239 1240 #define REG(r, info, p) ((r) * (info)->stride + (4 * ((p) / 32))) 1241 1242 static int ocelot_gpio_set_direction(struct pinctrl_dev *pctldev, 1243 struct pinctrl_gpio_range *range, 1244 unsigned int pin, bool input) 1245 { 1246 struct ocelot_pinctrl *info = pinctrl_dev_get_drvdata(pctldev); 1247 unsigned int p = pin % 32; 1248 1249 regmap_update_bits(info->map, REG(OCELOT_GPIO_OE, info, pin), BIT(p), 1250 input ? 0 : BIT(p)); 1251 1252 return 0; 1253 } 1254 1255 static int ocelot_gpio_request_enable(struct pinctrl_dev *pctldev, 1256 struct pinctrl_gpio_range *range, 1257 unsigned int offset) 1258 { 1259 struct ocelot_pinctrl *info = pinctrl_dev_get_drvdata(pctldev); 1260 unsigned int p = offset % 32; 1261 1262 regmap_update_bits(info->map, REG_ALT(0, info, offset), 1263 BIT(p), 0); 1264 regmap_update_bits(info->map, REG_ALT(1, info, offset), 1265 BIT(p), 0); 1266 1267 return 0; 1268 } 1269 1270 static int lan966x_gpio_request_enable(struct pinctrl_dev *pctldev, 1271 struct pinctrl_gpio_range *range, 1272 unsigned int offset) 1273 { 1274 struct ocelot_pinctrl *info = pinctrl_dev_get_drvdata(pctldev); 1275 unsigned int p = offset % 32; 1276 1277 regmap_update_bits(info->map, REG_ALT(0, info, offset), 1278 BIT(p), 0); 1279 regmap_update_bits(info->map, REG_ALT(1, info, offset), 1280 BIT(p), 0); 1281 regmap_update_bits(info->map, REG_ALT(2, info, offset), 1282 BIT(p), 0); 1283 1284 return 0; 1285 } 1286 1287 static const struct pinmux_ops ocelot_pmx_ops = { 1288 .get_functions_count = ocelot_get_functions_count, 1289 .get_function_name = ocelot_get_function_name, 1290 .get_function_groups = ocelot_get_function_groups, 1291 .set_mux = ocelot_pinmux_set_mux, 1292 .gpio_set_direction = ocelot_gpio_set_direction, 1293 .gpio_request_enable = ocelot_gpio_request_enable, 1294 }; 1295 1296 static const struct pinmux_ops lan966x_pmx_ops = { 1297 .get_functions_count = ocelot_get_functions_count, 1298 .get_function_name = ocelot_get_function_name, 1299 .get_function_groups = ocelot_get_function_groups, 1300 .set_mux = lan966x_pinmux_set_mux, 1301 .gpio_set_direction = ocelot_gpio_set_direction, 1302 .gpio_request_enable = lan966x_gpio_request_enable, 1303 }; 1304 1305 static int ocelot_pctl_get_groups_count(struct pinctrl_dev *pctldev) 1306 { 1307 struct ocelot_pinctrl *info = pinctrl_dev_get_drvdata(pctldev); 1308 1309 return info->desc->npins; 1310 } 1311 1312 static const char *ocelot_pctl_get_group_name(struct pinctrl_dev *pctldev, 1313 unsigned int group) 1314 { 1315 struct ocelot_pinctrl *info = pinctrl_dev_get_drvdata(pctldev); 1316 1317 return info->desc->pins[group].name; 1318 } 1319 1320 static int ocelot_pctl_get_group_pins(struct pinctrl_dev *pctldev, 1321 unsigned int group, 1322 const unsigned int **pins, 1323 unsigned int *num_pins) 1324 { 1325 struct ocelot_pinctrl *info = pinctrl_dev_get_drvdata(pctldev); 1326 1327 *pins = &info->desc->pins[group].number; 1328 *num_pins = 1; 1329 1330 return 0; 1331 } 1332 1333 static int ocelot_hw_get_value(struct ocelot_pinctrl *info, 1334 unsigned int pin, 1335 unsigned int reg, 1336 int *val) 1337 { 1338 int ret = -EOPNOTSUPP; 1339 1340 if (info->pincfg) { 1341 const struct ocelot_pincfg_data *opd = info->pincfg_data; 1342 u32 regcfg; 1343 1344 ret = regmap_read(info->pincfg, 1345 pin * regmap_get_reg_stride(info->pincfg), 1346 ®cfg); 1347 if (ret) 1348 return ret; 1349 1350 ret = 0; 1351 switch (reg) { 1352 case PINCONF_BIAS: 1353 *val = regcfg & (opd->pd_bit | opd->pu_bit); 1354 break; 1355 1356 case PINCONF_SCHMITT: 1357 *val = regcfg & opd->schmitt_bit; 1358 break; 1359 1360 case PINCONF_DRIVE_STRENGTH: 1361 *val = regcfg & opd->drive_bits; 1362 break; 1363 1364 default: 1365 ret = -EOPNOTSUPP; 1366 break; 1367 } 1368 } 1369 return ret; 1370 } 1371 1372 static int ocelot_pincfg_clrsetbits(struct ocelot_pinctrl *info, u32 regaddr, 1373 u32 clrbits, u32 setbits) 1374 { 1375 u32 val; 1376 int ret; 1377 1378 ret = regmap_read(info->pincfg, 1379 regaddr * regmap_get_reg_stride(info->pincfg), 1380 &val); 1381 if (ret) 1382 return ret; 1383 1384 val &= ~clrbits; 1385 val |= setbits; 1386 1387 ret = regmap_write(info->pincfg, 1388 regaddr * regmap_get_reg_stride(info->pincfg), 1389 val); 1390 1391 return ret; 1392 } 1393 1394 static int ocelot_hw_set_value(struct ocelot_pinctrl *info, 1395 unsigned int pin, 1396 unsigned int reg, 1397 int val) 1398 { 1399 int ret = -EOPNOTSUPP; 1400 1401 if (info->pincfg) { 1402 const struct ocelot_pincfg_data *opd = info->pincfg_data; 1403 1404 ret = 0; 1405 switch (reg) { 1406 case PINCONF_BIAS: 1407 ret = ocelot_pincfg_clrsetbits(info, pin, 1408 opd->pd_bit | opd->pu_bit, 1409 val); 1410 break; 1411 1412 case PINCONF_SCHMITT: 1413 ret = ocelot_pincfg_clrsetbits(info, pin, 1414 opd->schmitt_bit, 1415 val); 1416 break; 1417 1418 case PINCONF_DRIVE_STRENGTH: 1419 if (val <= 3) 1420 ret = ocelot_pincfg_clrsetbits(info, pin, 1421 opd->drive_bits, 1422 val); 1423 else 1424 ret = -EINVAL; 1425 break; 1426 1427 default: 1428 ret = -EOPNOTSUPP; 1429 break; 1430 } 1431 } 1432 return ret; 1433 } 1434 1435 static int ocelot_pinconf_get(struct pinctrl_dev *pctldev, 1436 unsigned int pin, unsigned long *config) 1437 { 1438 struct ocelot_pinctrl *info = pinctrl_dev_get_drvdata(pctldev); 1439 u32 param = pinconf_to_config_param(*config); 1440 int val, err; 1441 1442 switch (param) { 1443 case PIN_CONFIG_BIAS_DISABLE: 1444 case PIN_CONFIG_BIAS_PULL_UP: 1445 case PIN_CONFIG_BIAS_PULL_DOWN: 1446 err = ocelot_hw_get_value(info, pin, PINCONF_BIAS, &val); 1447 if (err) 1448 return err; 1449 if (param == PIN_CONFIG_BIAS_DISABLE) 1450 val = (val == 0); 1451 else if (param == PIN_CONFIG_BIAS_PULL_DOWN) 1452 val = !!(val & info->pincfg_data->pd_bit); 1453 else /* PIN_CONFIG_BIAS_PULL_UP */ 1454 val = !!(val & info->pincfg_data->pu_bit); 1455 break; 1456 1457 case PIN_CONFIG_INPUT_SCHMITT_ENABLE: 1458 if (!info->pincfg_data->schmitt_bit) 1459 return -EOPNOTSUPP; 1460 1461 err = ocelot_hw_get_value(info, pin, PINCONF_SCHMITT, &val); 1462 if (err) 1463 return err; 1464 1465 val = !!(val & info->pincfg_data->schmitt_bit); 1466 break; 1467 1468 case PIN_CONFIG_DRIVE_STRENGTH: 1469 err = ocelot_hw_get_value(info, pin, PINCONF_DRIVE_STRENGTH, 1470 &val); 1471 if (err) 1472 return err; 1473 break; 1474 1475 case PIN_CONFIG_OUTPUT: 1476 err = regmap_read(info->map, REG(OCELOT_GPIO_OUT, info, pin), 1477 &val); 1478 if (err) 1479 return err; 1480 val = !!(val & BIT(pin % 32)); 1481 break; 1482 1483 case PIN_CONFIG_INPUT_ENABLE: 1484 case PIN_CONFIG_OUTPUT_ENABLE: 1485 err = regmap_read(info->map, REG(OCELOT_GPIO_OE, info, pin), 1486 &val); 1487 if (err) 1488 return err; 1489 val = val & BIT(pin % 32); 1490 if (param == PIN_CONFIG_OUTPUT_ENABLE) 1491 val = !!val; 1492 else 1493 val = !val; 1494 break; 1495 1496 default: 1497 return -EOPNOTSUPP; 1498 } 1499 1500 *config = pinconf_to_config_packed(param, val); 1501 1502 return 0; 1503 } 1504 1505 static int ocelot_pinconf_set(struct pinctrl_dev *pctldev, unsigned int pin, 1506 unsigned long *configs, unsigned int num_configs) 1507 { 1508 struct ocelot_pinctrl *info = pinctrl_dev_get_drvdata(pctldev); 1509 const struct ocelot_pincfg_data *opd = info->pincfg_data; 1510 u32 param, arg, p; 1511 int cfg, err = 0; 1512 1513 for (cfg = 0; cfg < num_configs; cfg++) { 1514 param = pinconf_to_config_param(configs[cfg]); 1515 arg = pinconf_to_config_argument(configs[cfg]); 1516 1517 switch (param) { 1518 case PIN_CONFIG_BIAS_DISABLE: 1519 case PIN_CONFIG_BIAS_PULL_UP: 1520 case PIN_CONFIG_BIAS_PULL_DOWN: 1521 arg = (param == PIN_CONFIG_BIAS_DISABLE) ? 0 : 1522 (param == PIN_CONFIG_BIAS_PULL_UP) ? 1523 opd->pu_bit : opd->pd_bit; 1524 1525 err = ocelot_hw_set_value(info, pin, PINCONF_BIAS, arg); 1526 if (err) 1527 goto err; 1528 1529 break; 1530 1531 case PIN_CONFIG_INPUT_SCHMITT_ENABLE: 1532 if (!opd->schmitt_bit) 1533 return -EOPNOTSUPP; 1534 1535 arg = arg ? opd->schmitt_bit : 0; 1536 err = ocelot_hw_set_value(info, pin, PINCONF_SCHMITT, 1537 arg); 1538 if (err) 1539 goto err; 1540 1541 break; 1542 1543 case PIN_CONFIG_DRIVE_STRENGTH: 1544 err = ocelot_hw_set_value(info, pin, 1545 PINCONF_DRIVE_STRENGTH, 1546 arg); 1547 if (err) 1548 goto err; 1549 1550 break; 1551 1552 case PIN_CONFIG_OUTPUT_ENABLE: 1553 case PIN_CONFIG_INPUT_ENABLE: 1554 case PIN_CONFIG_OUTPUT: 1555 p = pin % 32; 1556 if (arg) 1557 regmap_write(info->map, 1558 REG(OCELOT_GPIO_OUT_SET, info, 1559 pin), 1560 BIT(p)); 1561 else 1562 regmap_write(info->map, 1563 REG(OCELOT_GPIO_OUT_CLR, info, 1564 pin), 1565 BIT(p)); 1566 regmap_update_bits(info->map, 1567 REG(OCELOT_GPIO_OE, info, pin), 1568 BIT(p), 1569 param == PIN_CONFIG_INPUT_ENABLE ? 1570 0 : BIT(p)); 1571 break; 1572 1573 default: 1574 err = -EOPNOTSUPP; 1575 } 1576 } 1577 err: 1578 return err; 1579 } 1580 1581 static const struct pinconf_ops ocelot_confops = { 1582 .is_generic = true, 1583 .pin_config_get = ocelot_pinconf_get, 1584 .pin_config_set = ocelot_pinconf_set, 1585 .pin_config_config_dbg_show = pinconf_generic_dump_config, 1586 }; 1587 1588 static const struct pinctrl_ops ocelot_pctl_ops = { 1589 .get_groups_count = ocelot_pctl_get_groups_count, 1590 .get_group_name = ocelot_pctl_get_group_name, 1591 .get_group_pins = ocelot_pctl_get_group_pins, 1592 .dt_node_to_map = pinconf_generic_dt_node_to_map_pin, 1593 .dt_free_map = pinconf_generic_dt_free_map, 1594 }; 1595 1596 static struct ocelot_match_data luton_desc = { 1597 .desc = { 1598 .name = "luton-pinctrl", 1599 .pins = luton_pins, 1600 .npins = ARRAY_SIZE(luton_pins), 1601 .pctlops = &ocelot_pctl_ops, 1602 .pmxops = &ocelot_pmx_ops, 1603 .owner = THIS_MODULE, 1604 }, 1605 }; 1606 1607 static struct ocelot_match_data serval_desc = { 1608 .desc = { 1609 .name = "serval-pinctrl", 1610 .pins = serval_pins, 1611 .npins = ARRAY_SIZE(serval_pins), 1612 .pctlops = &ocelot_pctl_ops, 1613 .pmxops = &ocelot_pmx_ops, 1614 .owner = THIS_MODULE, 1615 }, 1616 }; 1617 1618 static struct ocelot_match_data ocelot_desc = { 1619 .desc = { 1620 .name = "ocelot-pinctrl", 1621 .pins = ocelot_pins, 1622 .npins = ARRAY_SIZE(ocelot_pins), 1623 .pctlops = &ocelot_pctl_ops, 1624 .pmxops = &ocelot_pmx_ops, 1625 .owner = THIS_MODULE, 1626 }, 1627 }; 1628 1629 static struct ocelot_match_data jaguar2_desc = { 1630 .desc = { 1631 .name = "jaguar2-pinctrl", 1632 .pins = jaguar2_pins, 1633 .npins = ARRAY_SIZE(jaguar2_pins), 1634 .pctlops = &ocelot_pctl_ops, 1635 .pmxops = &ocelot_pmx_ops, 1636 .owner = THIS_MODULE, 1637 }, 1638 }; 1639 1640 static struct ocelot_match_data servalt_desc = { 1641 .desc = { 1642 .name = "servalt-pinctrl", 1643 .pins = servalt_pins, 1644 .npins = ARRAY_SIZE(servalt_pins), 1645 .pctlops = &ocelot_pctl_ops, 1646 .pmxops = &ocelot_pmx_ops, 1647 .owner = THIS_MODULE, 1648 }, 1649 }; 1650 1651 static struct ocelot_match_data sparx5_desc = { 1652 .desc = { 1653 .name = "sparx5-pinctrl", 1654 .pins = sparx5_pins, 1655 .npins = ARRAY_SIZE(sparx5_pins), 1656 .pctlops = &ocelot_pctl_ops, 1657 .pmxops = &ocelot_pmx_ops, 1658 .confops = &ocelot_confops, 1659 .owner = THIS_MODULE, 1660 }, 1661 .pincfg_data = { 1662 .pd_bit = BIT(4), 1663 .pu_bit = BIT(3), 1664 .drive_bits = GENMASK(1, 0), 1665 .schmitt_bit = BIT(2), 1666 }, 1667 }; 1668 1669 static struct ocelot_match_data lan966x_desc = { 1670 .desc = { 1671 .name = "lan966x-pinctrl", 1672 .pins = lan966x_pins, 1673 .npins = ARRAY_SIZE(lan966x_pins), 1674 .pctlops = &ocelot_pctl_ops, 1675 .pmxops = &lan966x_pmx_ops, 1676 .confops = &ocelot_confops, 1677 .owner = THIS_MODULE, 1678 }, 1679 .pincfg_data = { 1680 .pd_bit = BIT(3), 1681 .pu_bit = BIT(2), 1682 .drive_bits = GENMASK(1, 0), 1683 }, 1684 }; 1685 1686 static int ocelot_create_group_func_map(struct device *dev, 1687 struct ocelot_pinctrl *info) 1688 { 1689 int f, npins, i; 1690 u8 *pins = kcalloc(info->desc->npins, sizeof(u8), GFP_KERNEL); 1691 1692 if (!pins) 1693 return -ENOMEM; 1694 1695 for (f = 0; f < FUNC_MAX; f++) { 1696 for (npins = 0, i = 0; i < info->desc->npins; i++) { 1697 if (ocelot_pin_function_idx(info, i, f) >= 0) 1698 pins[npins++] = i; 1699 } 1700 1701 if (!npins) 1702 continue; 1703 1704 info->func[f].ngroups = npins; 1705 info->func[f].groups = devm_kcalloc(dev, npins, sizeof(char *), 1706 GFP_KERNEL); 1707 if (!info->func[f].groups) { 1708 kfree(pins); 1709 return -ENOMEM; 1710 } 1711 1712 for (i = 0; i < npins; i++) 1713 info->func[f].groups[i] = 1714 info->desc->pins[pins[i]].name; 1715 } 1716 1717 kfree(pins); 1718 1719 return 0; 1720 } 1721 1722 static int ocelot_pinctrl_register(struct platform_device *pdev, 1723 struct ocelot_pinctrl *info) 1724 { 1725 int ret; 1726 1727 ret = ocelot_create_group_func_map(&pdev->dev, info); 1728 if (ret) { 1729 dev_err(&pdev->dev, "Unable to create group func map.\n"); 1730 return ret; 1731 } 1732 1733 info->pctl = devm_pinctrl_register(&pdev->dev, info->desc, info); 1734 if (IS_ERR(info->pctl)) { 1735 dev_err(&pdev->dev, "Failed to register pinctrl\n"); 1736 return PTR_ERR(info->pctl); 1737 } 1738 1739 return 0; 1740 } 1741 1742 static int ocelot_gpio_get(struct gpio_chip *chip, unsigned int offset) 1743 { 1744 struct ocelot_pinctrl *info = gpiochip_get_data(chip); 1745 unsigned int val; 1746 1747 regmap_read(info->map, REG(OCELOT_GPIO_IN, info, offset), &val); 1748 1749 return !!(val & BIT(offset % 32)); 1750 } 1751 1752 static void ocelot_gpio_set(struct gpio_chip *chip, unsigned int offset, 1753 int value) 1754 { 1755 struct ocelot_pinctrl *info = gpiochip_get_data(chip); 1756 1757 if (value) 1758 regmap_write(info->map, REG(OCELOT_GPIO_OUT_SET, info, offset), 1759 BIT(offset % 32)); 1760 else 1761 regmap_write(info->map, REG(OCELOT_GPIO_OUT_CLR, info, offset), 1762 BIT(offset % 32)); 1763 } 1764 1765 static int ocelot_gpio_get_direction(struct gpio_chip *chip, 1766 unsigned int offset) 1767 { 1768 struct ocelot_pinctrl *info = gpiochip_get_data(chip); 1769 unsigned int val; 1770 1771 regmap_read(info->map, REG(OCELOT_GPIO_OE, info, offset), &val); 1772 1773 if (val & BIT(offset % 32)) 1774 return GPIO_LINE_DIRECTION_OUT; 1775 1776 return GPIO_LINE_DIRECTION_IN; 1777 } 1778 1779 static int ocelot_gpio_direction_input(struct gpio_chip *chip, 1780 unsigned int offset) 1781 { 1782 return pinctrl_gpio_direction_input(chip->base + offset); 1783 } 1784 1785 static int ocelot_gpio_direction_output(struct gpio_chip *chip, 1786 unsigned int offset, int value) 1787 { 1788 struct ocelot_pinctrl *info = gpiochip_get_data(chip); 1789 unsigned int pin = BIT(offset % 32); 1790 1791 if (value) 1792 regmap_write(info->map, REG(OCELOT_GPIO_OUT_SET, info, offset), 1793 pin); 1794 else 1795 regmap_write(info->map, REG(OCELOT_GPIO_OUT_CLR, info, offset), 1796 pin); 1797 1798 return pinctrl_gpio_direction_output(chip->base + offset); 1799 } 1800 1801 static const struct gpio_chip ocelot_gpiolib_chip = { 1802 .request = gpiochip_generic_request, 1803 .free = gpiochip_generic_free, 1804 .set = ocelot_gpio_set, 1805 .get = ocelot_gpio_get, 1806 .get_direction = ocelot_gpio_get_direction, 1807 .direction_input = ocelot_gpio_direction_input, 1808 .direction_output = ocelot_gpio_direction_output, 1809 .owner = THIS_MODULE, 1810 }; 1811 1812 static void ocelot_irq_mask(struct irq_data *data) 1813 { 1814 struct gpio_chip *chip = irq_data_get_irq_chip_data(data); 1815 struct ocelot_pinctrl *info = gpiochip_get_data(chip); 1816 unsigned int gpio = irqd_to_hwirq(data); 1817 1818 regmap_update_bits(info->map, REG(OCELOT_GPIO_INTR_ENA, info, gpio), 1819 BIT(gpio % 32), 0); 1820 gpiochip_disable_irq(chip, gpio); 1821 } 1822 1823 static void ocelot_irq_work(struct work_struct *work) 1824 { 1825 struct ocelot_irq_work *w = container_of(work, struct ocelot_irq_work, irq_work); 1826 struct irq_chip *parent_chip = irq_desc_get_chip(w->irq_desc); 1827 struct gpio_chip *chip = irq_desc_get_chip_data(w->irq_desc); 1828 struct irq_data *data = irq_desc_get_irq_data(w->irq_desc); 1829 unsigned int gpio = irqd_to_hwirq(data); 1830 1831 local_irq_disable(); 1832 chained_irq_enter(parent_chip, w->irq_desc); 1833 generic_handle_domain_irq(chip->irq.domain, gpio); 1834 chained_irq_exit(parent_chip, w->irq_desc); 1835 local_irq_enable(); 1836 1837 kfree(w); 1838 } 1839 1840 static void ocelot_irq_unmask_level(struct irq_data *data) 1841 { 1842 struct gpio_chip *chip = irq_data_get_irq_chip_data(data); 1843 struct ocelot_pinctrl *info = gpiochip_get_data(chip); 1844 struct irq_desc *desc = irq_data_to_desc(data); 1845 unsigned int gpio = irqd_to_hwirq(data); 1846 unsigned int bit = BIT(gpio % 32); 1847 bool ack = false, active = false; 1848 u8 trigger_level; 1849 int val; 1850 1851 trigger_level = irqd_get_trigger_type(data); 1852 1853 /* Check if the interrupt line is still active. */ 1854 regmap_read(info->map, REG(OCELOT_GPIO_IN, info, gpio), &val); 1855 if ((!(val & bit) && trigger_level == IRQ_TYPE_LEVEL_LOW) || 1856 (val & bit && trigger_level == IRQ_TYPE_LEVEL_HIGH)) 1857 active = true; 1858 1859 /* 1860 * Check if the interrupt controller has seen any changes in the 1861 * interrupt line. 1862 */ 1863 regmap_read(info->map, REG(OCELOT_GPIO_INTR, info, gpio), &val); 1864 if (val & bit) 1865 ack = true; 1866 1867 /* Try to clear any rising edges */ 1868 if (!active && ack) 1869 regmap_write_bits(info->map, REG(OCELOT_GPIO_INTR, info, gpio), 1870 bit, bit); 1871 1872 /* Enable the interrupt now */ 1873 gpiochip_enable_irq(chip, gpio); 1874 regmap_update_bits(info->map, REG(OCELOT_GPIO_INTR_ENA, info, gpio), 1875 bit, bit); 1876 1877 /* 1878 * In case the interrupt line is still active then it means that 1879 * there happen another interrupt while the line was active. 1880 * So we missed that one, so we need to kick the interrupt again 1881 * handler. 1882 */ 1883 regmap_read(info->map, REG(OCELOT_GPIO_IN, info, gpio), &val); 1884 if ((!(val & bit) && trigger_level == IRQ_TYPE_LEVEL_LOW) || 1885 (val & bit && trigger_level == IRQ_TYPE_LEVEL_HIGH)) 1886 active = true; 1887 1888 if (active) { 1889 struct ocelot_irq_work *work; 1890 1891 work = kmalloc(sizeof(*work), GFP_ATOMIC); 1892 if (!work) 1893 return; 1894 1895 work->irq_desc = desc; 1896 INIT_WORK(&work->irq_work, ocelot_irq_work); 1897 queue_work(info->wq, &work->irq_work); 1898 } 1899 } 1900 1901 static void ocelot_irq_unmask(struct irq_data *data) 1902 { 1903 struct gpio_chip *chip = irq_data_get_irq_chip_data(data); 1904 struct ocelot_pinctrl *info = gpiochip_get_data(chip); 1905 unsigned int gpio = irqd_to_hwirq(data); 1906 1907 gpiochip_enable_irq(chip, gpio); 1908 regmap_update_bits(info->map, REG(OCELOT_GPIO_INTR_ENA, info, gpio), 1909 BIT(gpio % 32), BIT(gpio % 32)); 1910 } 1911 1912 static void ocelot_irq_ack(struct irq_data *data) 1913 { 1914 struct gpio_chip *chip = irq_data_get_irq_chip_data(data); 1915 struct ocelot_pinctrl *info = gpiochip_get_data(chip); 1916 unsigned int gpio = irqd_to_hwirq(data); 1917 1918 regmap_write_bits(info->map, REG(OCELOT_GPIO_INTR, info, gpio), 1919 BIT(gpio % 32), BIT(gpio % 32)); 1920 } 1921 1922 static int ocelot_irq_set_type(struct irq_data *data, unsigned int type); 1923 1924 static struct irq_chip ocelot_level_irqchip = { 1925 .name = "gpio", 1926 .irq_mask = ocelot_irq_mask, 1927 .irq_ack = ocelot_irq_ack, 1928 .irq_unmask = ocelot_irq_unmask_level, 1929 .flags = IRQCHIP_IMMUTABLE, 1930 .irq_set_type = ocelot_irq_set_type, 1931 GPIOCHIP_IRQ_RESOURCE_HELPERS 1932 }; 1933 1934 static struct irq_chip ocelot_irqchip = { 1935 .name = "gpio", 1936 .irq_mask = ocelot_irq_mask, 1937 .irq_ack = ocelot_irq_ack, 1938 .irq_unmask = ocelot_irq_unmask, 1939 .irq_set_type = ocelot_irq_set_type, 1940 .flags = IRQCHIP_IMMUTABLE, 1941 GPIOCHIP_IRQ_RESOURCE_HELPERS 1942 }; 1943 1944 static int ocelot_irq_set_type(struct irq_data *data, unsigned int type) 1945 { 1946 if (type & (IRQ_TYPE_LEVEL_HIGH | IRQ_TYPE_LEVEL_LOW)) 1947 irq_set_chip_handler_name_locked(data, &ocelot_level_irqchip, 1948 handle_level_irq, NULL); 1949 if (type & IRQ_TYPE_EDGE_BOTH) 1950 irq_set_chip_handler_name_locked(data, &ocelot_irqchip, 1951 handle_edge_irq, NULL); 1952 1953 return 0; 1954 } 1955 1956 static void ocelot_irq_handler(struct irq_desc *desc) 1957 { 1958 struct irq_chip *parent_chip = irq_desc_get_chip(desc); 1959 struct gpio_chip *chip = irq_desc_get_handler_data(desc); 1960 struct ocelot_pinctrl *info = gpiochip_get_data(chip); 1961 unsigned int id_reg = OCELOT_GPIO_INTR_IDENT * info->stride; 1962 unsigned int reg = 0, irq, i; 1963 unsigned long irqs; 1964 1965 chained_irq_enter(parent_chip, desc); 1966 1967 for (i = 0; i < info->stride; i++) { 1968 regmap_read(info->map, id_reg + 4 * i, ®); 1969 if (!reg) 1970 continue; 1971 1972 irqs = reg; 1973 1974 for_each_set_bit(irq, &irqs, 1975 min(32U, info->desc->npins - 32 * i)) 1976 generic_handle_domain_irq(chip->irq.domain, irq + 32 * i); 1977 } 1978 1979 chained_irq_exit(parent_chip, desc); 1980 } 1981 1982 static int ocelot_gpiochip_register(struct platform_device *pdev, 1983 struct ocelot_pinctrl *info) 1984 { 1985 struct gpio_chip *gc; 1986 struct gpio_irq_chip *girq; 1987 int irq; 1988 1989 info->gpio_chip = ocelot_gpiolib_chip; 1990 1991 gc = &info->gpio_chip; 1992 gc->ngpio = info->desc->npins; 1993 gc->parent = &pdev->dev; 1994 gc->base = -1; 1995 gc->label = "ocelot-gpio"; 1996 1997 irq = platform_get_irq_optional(pdev, 0); 1998 if (irq > 0) { 1999 girq = &gc->irq; 2000 gpio_irq_chip_set_chip(girq, &ocelot_irqchip); 2001 girq->parent_handler = ocelot_irq_handler; 2002 girq->num_parents = 1; 2003 girq->parents = devm_kcalloc(&pdev->dev, 1, 2004 sizeof(*girq->parents), 2005 GFP_KERNEL); 2006 if (!girq->parents) 2007 return -ENOMEM; 2008 girq->parents[0] = irq; 2009 girq->default_type = IRQ_TYPE_NONE; 2010 girq->handler = handle_edge_irq; 2011 } 2012 2013 return devm_gpiochip_add_data(&pdev->dev, gc, info); 2014 } 2015 2016 static const struct of_device_id ocelot_pinctrl_of_match[] = { 2017 { .compatible = "mscc,luton-pinctrl", .data = &luton_desc }, 2018 { .compatible = "mscc,serval-pinctrl", .data = &serval_desc }, 2019 { .compatible = "mscc,ocelot-pinctrl", .data = &ocelot_desc }, 2020 { .compatible = "mscc,jaguar2-pinctrl", .data = &jaguar2_desc }, 2021 { .compatible = "mscc,servalt-pinctrl", .data = &servalt_desc }, 2022 { .compatible = "microchip,sparx5-pinctrl", .data = &sparx5_desc }, 2023 { .compatible = "microchip,lan966x-pinctrl", .data = &lan966x_desc }, 2024 {}, 2025 }; 2026 MODULE_DEVICE_TABLE(of, ocelot_pinctrl_of_match); 2027 2028 static struct regmap *ocelot_pinctrl_create_pincfg(struct platform_device *pdev, 2029 const struct ocelot_pinctrl *info) 2030 { 2031 void __iomem *base; 2032 2033 const struct regmap_config regmap_config = { 2034 .reg_bits = 32, 2035 .val_bits = 32, 2036 .reg_stride = 4, 2037 .max_register = info->desc->npins * 4, 2038 .name = "pincfg", 2039 }; 2040 2041 base = devm_platform_ioremap_resource(pdev, 1); 2042 if (IS_ERR(base)) { 2043 dev_dbg(&pdev->dev, "Failed to ioremap config registers (no extended pinconf)\n"); 2044 return NULL; 2045 } 2046 2047 return devm_regmap_init_mmio(&pdev->dev, base, ®map_config); 2048 } 2049 2050 static void ocelot_destroy_workqueue(void *data) 2051 { 2052 destroy_workqueue(data); 2053 } 2054 2055 static int ocelot_pinctrl_probe(struct platform_device *pdev) 2056 { 2057 const struct ocelot_match_data *data; 2058 struct device *dev = &pdev->dev; 2059 struct ocelot_pinctrl *info; 2060 struct reset_control *reset; 2061 struct regmap *pincfg; 2062 int ret; 2063 struct regmap_config regmap_config = { 2064 .reg_bits = 32, 2065 .val_bits = 32, 2066 .reg_stride = 4, 2067 }; 2068 2069 info = devm_kzalloc(dev, sizeof(*info), GFP_KERNEL); 2070 if (!info) 2071 return -ENOMEM; 2072 2073 data = device_get_match_data(dev); 2074 if (!data) 2075 return -EINVAL; 2076 2077 info->desc = devm_kmemdup(dev, &data->desc, sizeof(*info->desc), 2078 GFP_KERNEL); 2079 if (!info->desc) 2080 return -ENOMEM; 2081 2082 info->wq = alloc_ordered_workqueue("ocelot_ordered", 0); 2083 if (!info->wq) 2084 return -ENOMEM; 2085 2086 ret = devm_add_action_or_reset(dev, ocelot_destroy_workqueue, 2087 info->wq); 2088 if (ret) 2089 return ret; 2090 2091 info->pincfg_data = &data->pincfg_data; 2092 2093 reset = devm_reset_control_get_optional_shared(dev, "switch"); 2094 if (IS_ERR(reset)) 2095 return dev_err_probe(dev, PTR_ERR(reset), 2096 "Failed to get reset\n"); 2097 reset_control_reset(reset); 2098 2099 info->stride = 1 + (info->desc->npins - 1) / 32; 2100 2101 regmap_config.max_register = OCELOT_GPIO_SD_MAP * info->stride + 15 * 4; 2102 2103 info->map = ocelot_regmap_from_resource(pdev, 0, ®map_config); 2104 if (IS_ERR(info->map)) 2105 return dev_err_probe(dev, PTR_ERR(info->map), 2106 "Failed to create regmap\n"); 2107 dev_set_drvdata(dev, info); 2108 info->dev = dev; 2109 2110 /* Pinconf registers */ 2111 if (info->desc->confops) { 2112 pincfg = ocelot_pinctrl_create_pincfg(pdev, info); 2113 if (IS_ERR(pincfg)) 2114 dev_dbg(dev, "Failed to create pincfg regmap\n"); 2115 else 2116 info->pincfg = pincfg; 2117 } 2118 2119 ret = ocelot_pinctrl_register(pdev, info); 2120 if (ret) 2121 return ret; 2122 2123 ret = ocelot_gpiochip_register(pdev, info); 2124 if (ret) 2125 return ret; 2126 2127 dev_info(dev, "driver registered\n"); 2128 2129 return 0; 2130 } 2131 2132 static struct platform_driver ocelot_pinctrl_driver = { 2133 .driver = { 2134 .name = "pinctrl-ocelot", 2135 .of_match_table = of_match_ptr(ocelot_pinctrl_of_match), 2136 .suppress_bind_attrs = true, 2137 }, 2138 .probe = ocelot_pinctrl_probe, 2139 }; 2140 module_platform_driver(ocelot_pinctrl_driver); 2141 2142 MODULE_DESCRIPTION("Ocelot Chip Pinctrl Driver"); 2143 MODULE_LICENSE("Dual MIT/GPL"); 2144