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