1 // SPDX-License-Identifier: GPL-2.0
2 // Copyright (c) 2016-2018 Nuvoton Technology corporation.
3 // Copyright (c) 2016, Dell Inc
4 // Copyright (c) 2021-2022 Jonathan Neuschäfer
5 //
6 // This driver uses the following registers:
7 // - Pin mux registers, in the GCR (general control registers) block
8 // - GPIO registers, specific to each GPIO bank
9 // - GPIO event (interrupt) registers, located centrally in the GPIO register
10 //   block, shared between all GPIO banks
11 
12 #include <linux/device.h>
13 #include <linux/fwnode.h>
14 #include <linux/gpio/driver.h>
15 #include <linux/interrupt.h>
16 #include <linux/irq.h>
17 #include <linux/mfd/syscon.h>
18 #include <linux/module.h>
19 #include <linux/mod_devicetable.h>
20 #include <linux/platform_device.h>
21 #include <linux/regmap.h>
22 
23 #include <linux/pinctrl/pinconf.h>
24 #include <linux/pinctrl/pinconf-generic.h>
25 #include <linux/pinctrl/pinctrl.h>
26 #include <linux/pinctrl/pinmux.h>
27 
28 #include "../core.h"
29 
30 /* GCR registers */
31 #define WPCM450_GCR_MFSEL1	0x0c
32 #define WPCM450_GCR_MFSEL2	0x10
33 #define WPCM450_GCR_NONE	0
34 
35 /* GPIO event (interrupt) registers */
36 #define WPCM450_GPEVTYPE	0x00
37 #define WPCM450_GPEVPOL		0x04
38 #define WPCM450_GPEVDBNC	0x08
39 #define WPCM450_GPEVEN		0x0c
40 #define WPCM450_GPEVST		0x10
41 
42 #define WPCM450_NUM_BANKS	8
43 #define WPCM450_NUM_GPIOS	128
44 #define WPCM450_NUM_GPIO_IRQS	4
45 
46 struct wpcm450_pinctrl;
47 struct wpcm450_bank;
48 
49 struct wpcm450_gpio {
50 	struct gpio_chip	gc;
51 	struct wpcm450_pinctrl	*pctrl;
52 	const struct wpcm450_bank *bank;
53 };
54 
55 struct wpcm450_pinctrl {
56 	struct pinctrl_dev	*pctldev;
57 	struct device		*dev;
58 	struct irq_domain	*domain;
59 	struct regmap		*gcr_regmap;
60 	void __iomem		*gpio_base;
61 	struct wpcm450_gpio	gpio_bank[WPCM450_NUM_BANKS];
62 	unsigned long		both_edges;
63 
64 	/*
65 	 * This spin lock protects registers and struct wpcm450_pinctrl fields
66 	 * against concurrent access.
67 	 */
68 	raw_spinlock_t		lock;
69 };
70 
71 struct wpcm450_bank {
72 	/* Range of GPIOs in this port */
73 	u8 base;
74 	u8 length;
75 
76 	/* Register offsets (0 = register doesn't exist in this port) */
77 	u8 cfg0, cfg1, cfg2;
78 	u8 blink;
79 	u8 dataout, datain;
80 
81 	/* Interrupt bit mapping */
82 	u8 first_irq_bit;   /* First bit in GPEVST that belongs to this bank */
83 	u8 num_irqs;        /* Number of IRQ-capable GPIOs in this bank */
84 	u8 first_irq_gpio;  /* First IRQ-capable GPIO in this bank */
85 };
86 
87 static const struct wpcm450_bank wpcm450_banks[WPCM450_NUM_BANKS] = {
88 	/*  range   cfg0  cfg1  cfg2 blink  out   in     IRQ map */
89 	{   0, 16,  0x14, 0x18,    0,    0, 0x1c, 0x20,  0, 16, 0 },
90 	{  16, 16,  0x24, 0x28, 0x2c, 0x30, 0x34, 0x38, 16,  2, 8 },
91 	{  32, 16,  0x3c, 0x40, 0x44,    0, 0x48, 0x4c,  0,  0, 0 },
92 	{  48, 16,  0x50, 0x54, 0x58,    0, 0x5c, 0x60,  0,  0, 0 },
93 	{  64, 16,  0x64, 0x68, 0x6c,    0, 0x70, 0x74,  0,  0, 0 },
94 	{  80, 16,  0x78, 0x7c, 0x80,    0, 0x84, 0x88,  0,  0, 0 },
95 	{  96, 18,     0,    0,    0,    0,    0, 0x8c,  0,  0, 0 },
96 	{ 114, 14,  0x90, 0x94, 0x98,    0, 0x9c, 0xa0,  0,  0, 0 },
97 };
98 
wpcm450_gpio_irq_bitnum(struct wpcm450_gpio * gpio,struct irq_data * d)99 static int wpcm450_gpio_irq_bitnum(struct wpcm450_gpio *gpio, struct irq_data *d)
100 {
101 	const struct wpcm450_bank *bank = gpio->bank;
102 	int hwirq = irqd_to_hwirq(d);
103 
104 	if (hwirq < bank->first_irq_gpio)
105 		return -EINVAL;
106 
107 	if (hwirq - bank->first_irq_gpio >= bank->num_irqs)
108 		return -EINVAL;
109 
110 	return hwirq - bank->first_irq_gpio + bank->first_irq_bit;
111 }
112 
wpcm450_irq_bitnum_to_gpio(struct wpcm450_gpio * gpio,int bitnum)113 static int wpcm450_irq_bitnum_to_gpio(struct wpcm450_gpio *gpio, int bitnum)
114 {
115 	const struct wpcm450_bank *bank = gpio->bank;
116 
117 	if (bitnum < bank->first_irq_bit)
118 		return -EINVAL;
119 
120 	if (bitnum - bank->first_irq_bit > bank->num_irqs)
121 		return -EINVAL;
122 
123 	return bitnum - bank->first_irq_bit + bank->first_irq_gpio;
124 }
125 
wpcm450_gpio_irq_ack(struct irq_data * d)126 static void wpcm450_gpio_irq_ack(struct irq_data *d)
127 {
128 	struct wpcm450_gpio *gpio = gpiochip_get_data(irq_data_get_irq_chip_data(d));
129 	struct wpcm450_pinctrl *pctrl = gpio->pctrl;
130 	unsigned long flags;
131 	int bit;
132 
133 	bit = wpcm450_gpio_irq_bitnum(gpio, d);
134 	if (bit < 0)
135 		return;
136 
137 	raw_spin_lock_irqsave(&pctrl->lock, flags);
138 	iowrite32(BIT(bit), pctrl->gpio_base + WPCM450_GPEVST);
139 	raw_spin_unlock_irqrestore(&pctrl->lock, flags);
140 }
141 
wpcm450_gpio_irq_mask(struct irq_data * d)142 static void wpcm450_gpio_irq_mask(struct irq_data *d)
143 {
144 	struct gpio_chip *gc = irq_data_get_irq_chip_data(d);
145 	struct wpcm450_gpio *gpio = gpiochip_get_data(gc);
146 	struct wpcm450_pinctrl *pctrl = gpio->pctrl;
147 	unsigned long flags;
148 	unsigned long even;
149 	int bit;
150 
151 	bit = wpcm450_gpio_irq_bitnum(gpio, d);
152 	if (bit < 0)
153 		return;
154 
155 	raw_spin_lock_irqsave(&pctrl->lock, flags);
156 	even = ioread32(pctrl->gpio_base + WPCM450_GPEVEN);
157 	__assign_bit(bit, &even, 0);
158 	iowrite32(even, pctrl->gpio_base + WPCM450_GPEVEN);
159 	raw_spin_unlock_irqrestore(&pctrl->lock, flags);
160 
161 	gpiochip_disable_irq(gc, irqd_to_hwirq(d));
162 }
163 
wpcm450_gpio_irq_unmask(struct irq_data * d)164 static void wpcm450_gpio_irq_unmask(struct irq_data *d)
165 {
166 	struct gpio_chip *gc = irq_data_get_irq_chip_data(d);
167 	struct wpcm450_gpio *gpio = gpiochip_get_data(gc);
168 	struct wpcm450_pinctrl *pctrl = gpio->pctrl;
169 	unsigned long flags;
170 	unsigned long even;
171 	int bit;
172 
173 	bit = wpcm450_gpio_irq_bitnum(gpio, d);
174 	if (bit < 0)
175 		return;
176 
177 	gpiochip_enable_irq(gc, irqd_to_hwirq(d));
178 
179 	raw_spin_lock_irqsave(&pctrl->lock, flags);
180 	even = ioread32(pctrl->gpio_base + WPCM450_GPEVEN);
181 	__assign_bit(bit, &even, 1);
182 	iowrite32(even, pctrl->gpio_base + WPCM450_GPEVEN);
183 	raw_spin_unlock_irqrestore(&pctrl->lock, flags);
184 }
185 
186 /*
187  * This is an implementation of the gpio_chip->get() function, for use in
188  * wpcm450_gpio_fix_evpol. Unfortunately, we can't use the bgpio-provided
189  * implementation there, because it would require taking gpio_chip->bgpio_lock,
190  * which is a spin lock, but wpcm450_gpio_fix_evpol must work in contexts where
191  * a raw spin lock is held.
192  */
wpcm450_gpio_get(struct wpcm450_gpio * gpio,int offset)193 static int wpcm450_gpio_get(struct wpcm450_gpio *gpio, int offset)
194 {
195 	void __iomem *reg = gpio->pctrl->gpio_base + gpio->bank->datain;
196 	unsigned long flags;
197 	u32 level;
198 
199 	raw_spin_lock_irqsave(&gpio->pctrl->lock, flags);
200 	level = !!(ioread32(reg) & BIT(offset));
201 	raw_spin_unlock_irqrestore(&gpio->pctrl->lock, flags);
202 
203 	return level;
204 }
205 
206 /*
207  * Since the GPIO controller does not support dual-edge triggered interrupts
208  * (IRQ_TYPE_EDGE_BOTH), they are emulated using rising/falling edge triggered
209  * interrupts. wpcm450_gpio_fix_evpol sets the interrupt polarity for the
210  * specified emulated dual-edge triggered interrupts, so that the next edge can
211  * be detected.
212  */
wpcm450_gpio_fix_evpol(struct wpcm450_gpio * gpio,unsigned long all)213 static void wpcm450_gpio_fix_evpol(struct wpcm450_gpio *gpio, unsigned long all)
214 {
215 	struct wpcm450_pinctrl *pctrl = gpio->pctrl;
216 	unsigned int bit;
217 
218 	for_each_set_bit(bit, &all, 32) {
219 		int offset = wpcm450_irq_bitnum_to_gpio(gpio, bit);
220 		unsigned long evpol;
221 		unsigned long flags;
222 		int level;
223 
224 		do {
225 			level = wpcm450_gpio_get(gpio, offset);
226 
227 			/* Switch event polarity to the opposite of the current level */
228 			raw_spin_lock_irqsave(&pctrl->lock, flags);
229 			evpol = ioread32(pctrl->gpio_base + WPCM450_GPEVPOL);
230 			__assign_bit(bit, &evpol, !level);
231 			iowrite32(evpol, pctrl->gpio_base + WPCM450_GPEVPOL);
232 			raw_spin_unlock_irqrestore(&pctrl->lock, flags);
233 
234 		} while (wpcm450_gpio_get(gpio, offset) != level);
235 	}
236 }
237 
wpcm450_gpio_set_irq_type(struct irq_data * d,unsigned int flow_type)238 static int wpcm450_gpio_set_irq_type(struct irq_data *d, unsigned int flow_type)
239 {
240 	struct wpcm450_gpio *gpio = gpiochip_get_data(irq_data_get_irq_chip_data(d));
241 	struct wpcm450_pinctrl *pctrl = gpio->pctrl;
242 	unsigned long evtype, evpol;
243 	unsigned long flags;
244 	int ret = 0;
245 	int bit;
246 
247 	bit = wpcm450_gpio_irq_bitnum(gpio, d);
248 	if (bit < 0)
249 		return bit;
250 
251 	irq_set_handler_locked(d, handle_level_irq);
252 
253 	raw_spin_lock_irqsave(&pctrl->lock, flags);
254 	evtype = ioread32(pctrl->gpio_base + WPCM450_GPEVTYPE);
255 	evpol = ioread32(pctrl->gpio_base + WPCM450_GPEVPOL);
256 	__assign_bit(bit, &pctrl->both_edges, 0);
257 	switch (flow_type) {
258 	case IRQ_TYPE_LEVEL_LOW:
259 		__assign_bit(bit, &evtype, 1);
260 		__assign_bit(bit, &evpol, 0);
261 		break;
262 	case IRQ_TYPE_LEVEL_HIGH:
263 		__assign_bit(bit, &evtype, 1);
264 		__assign_bit(bit, &evpol, 1);
265 		break;
266 	case IRQ_TYPE_EDGE_FALLING:
267 		__assign_bit(bit, &evtype, 0);
268 		__assign_bit(bit, &evpol, 0);
269 		break;
270 	case IRQ_TYPE_EDGE_RISING:
271 		__assign_bit(bit, &evtype, 0);
272 		__assign_bit(bit, &evpol, 1);
273 		break;
274 	case IRQ_TYPE_EDGE_BOTH:
275 		__assign_bit(bit, &evtype, 0);
276 		__assign_bit(bit, &pctrl->both_edges, 1);
277 		break;
278 	default:
279 		ret = -EINVAL;
280 	}
281 	iowrite32(evtype, pctrl->gpio_base + WPCM450_GPEVTYPE);
282 	iowrite32(evpol, pctrl->gpio_base + WPCM450_GPEVPOL);
283 
284 	/* clear the event status for good measure */
285 	iowrite32(BIT(bit), pctrl->gpio_base + WPCM450_GPEVST);
286 
287 	raw_spin_unlock_irqrestore(&pctrl->lock, flags);
288 
289 	/* fix event polarity after clearing event status */
290 	wpcm450_gpio_fix_evpol(gpio, BIT(bit));
291 
292 	return ret;
293 }
294 
295 static const struct irq_chip wpcm450_gpio_irqchip = {
296 	.name = "WPCM450-GPIO-IRQ",
297 	.irq_ack = wpcm450_gpio_irq_ack,
298 	.irq_unmask = wpcm450_gpio_irq_unmask,
299 	.irq_mask = wpcm450_gpio_irq_mask,
300 	.irq_set_type = wpcm450_gpio_set_irq_type,
301 	.flags = IRQCHIP_IMMUTABLE,
302 	GPIOCHIP_IRQ_RESOURCE_HELPERS,
303 };
304 
wpcm450_gpio_irqhandler(struct irq_desc * desc)305 static void wpcm450_gpio_irqhandler(struct irq_desc *desc)
306 {
307 	struct wpcm450_gpio *gpio = gpiochip_get_data(irq_desc_get_handler_data(desc));
308 	struct wpcm450_pinctrl *pctrl = gpio->pctrl;
309 	struct irq_chip *chip = irq_desc_get_chip(desc);
310 	unsigned long pending;
311 	unsigned long flags;
312 	unsigned long ours;
313 	unsigned int bit;
314 
315 	ours = GENMASK(gpio->bank->num_irqs - 1, 0) << gpio->bank->first_irq_bit;
316 
317 	raw_spin_lock_irqsave(&pctrl->lock, flags);
318 
319 	pending = ioread32(pctrl->gpio_base + WPCM450_GPEVST);
320 	pending &= ioread32(pctrl->gpio_base + WPCM450_GPEVEN);
321 	pending &= ours;
322 
323 	raw_spin_unlock_irqrestore(&pctrl->lock, flags);
324 
325 	if (pending & pctrl->both_edges)
326 		wpcm450_gpio_fix_evpol(gpio, pending & pctrl->both_edges);
327 
328 	chained_irq_enter(chip, desc);
329 	for_each_set_bit(bit, &pending, 32) {
330 		int offset = wpcm450_irq_bitnum_to_gpio(gpio, bit);
331 
332 		generic_handle_domain_irq(gpio->gc.irq.domain, offset);
333 	}
334 	chained_irq_exit(chip, desc);
335 }
336 
337 static int smb0_pins[]  = { 115, 114 };
338 static int smb1_pins[]  = { 117, 116 };
339 static int smb2_pins[]  = { 119, 118 };
340 static int smb3_pins[]  = { 30, 31 };
341 static int smb4_pins[]  = { 28, 29 };
342 static int smb5_pins[]  = { 26, 27 };
343 
344 static int scs1_pins[] = { 32 };
345 static int scs2_pins[] = { 33 };
346 static int scs3_pins[] = { 34 };
347 
348 static int bsp_pins[] = { 41, 42 };
349 static int hsp1_pins[] = { 43, 44, 45, 46, 47, 61, 62, 63 };
350 static int hsp2_pins[] = { 48, 49, 50, 51, 52, 53, 54, 55 };
351 
352 static int r1err_pins[] = { 56 };
353 static int r1md_pins[] = { 57, 58 };
354 static int rmii2_pins[] = { 84, 85, 86, 87, 88, 89 };
355 static int r2err_pins[] = { 90 };
356 static int r2md_pins[] = { 91, 92 };
357 
358 static int kbcc_pins[] = { 94, 93 };
359 static int clko_pins[] = { 96 };
360 static int smi_pins[] = { 97 };
361 static int uinc_pins[] = { 19 };
362 static int mben_pins[] = {};
363 
364 static int gspi_pins[] = { 12, 13, 14, 15 };
365 static int sspi_pins[] = { 12, 13, 14, 15 };
366 
367 static int xcs1_pins[] = { 35 };
368 static int xcs2_pins[] = { 36 };
369 
370 static int sdio_pins[] = { 7, 22, 43, 44, 45, 46, 47, 60 };
371 
372 static int fi0_pins[] = { 64 };
373 static int fi1_pins[] = { 65 };
374 static int fi2_pins[] = { 66 };
375 static int fi3_pins[] = { 67 };
376 static int fi4_pins[] = { 68 };
377 static int fi5_pins[] = { 69 };
378 static int fi6_pins[] = { 70 };
379 static int fi7_pins[] = { 71 };
380 static int fi8_pins[] = { 72 };
381 static int fi9_pins[] = { 73 };
382 static int fi10_pins[] = { 74 };
383 static int fi11_pins[] = { 75 };
384 static int fi12_pins[] = { 76 };
385 static int fi13_pins[] = { 77 };
386 static int fi14_pins[] = { 78 };
387 static int fi15_pins[] = { 79 };
388 
389 static int pwm0_pins[] = { 80 };
390 static int pwm1_pins[] = { 81 };
391 static int pwm2_pins[] = { 82 };
392 static int pwm3_pins[] = { 83 };
393 static int pwm4_pins[] = { 20 };
394 static int pwm5_pins[] = { 21 };
395 static int pwm6_pins[] = { 16 };
396 static int pwm7_pins[] = { 17 };
397 
398 static int hg0_pins[] = { 20 };
399 static int hg1_pins[] = { 21 };
400 static int hg2_pins[] = { 22 };
401 static int hg3_pins[] = { 23 };
402 static int hg4_pins[] = { 24 };
403 static int hg5_pins[] = { 25 };
404 static int hg6_pins[] = { 59 };
405 static int hg7_pins[] = { 60 };
406 
407 #define WPCM450_GRPS \
408 	WPCM450_GRP(smb3), \
409 	WPCM450_GRP(smb4), \
410 	WPCM450_GRP(smb5), \
411 	WPCM450_GRP(scs1), \
412 	WPCM450_GRP(scs2), \
413 	WPCM450_GRP(scs3), \
414 	WPCM450_GRP(smb0), \
415 	WPCM450_GRP(smb1), \
416 	WPCM450_GRP(smb2), \
417 	WPCM450_GRP(bsp), \
418 	WPCM450_GRP(hsp1), \
419 	WPCM450_GRP(hsp2), \
420 	WPCM450_GRP(r1err), \
421 	WPCM450_GRP(r1md), \
422 	WPCM450_GRP(rmii2), \
423 	WPCM450_GRP(r2err), \
424 	WPCM450_GRP(r2md), \
425 	WPCM450_GRP(kbcc), \
426 	WPCM450_GRP(clko), \
427 	WPCM450_GRP(smi), \
428 	WPCM450_GRP(uinc), \
429 	WPCM450_GRP(gspi), \
430 	WPCM450_GRP(mben), \
431 	WPCM450_GRP(xcs2), \
432 	WPCM450_GRP(xcs1), \
433 	WPCM450_GRP(sdio), \
434 	WPCM450_GRP(sspi), \
435 	WPCM450_GRP(fi0), \
436 	WPCM450_GRP(fi1), \
437 	WPCM450_GRP(fi2), \
438 	WPCM450_GRP(fi3), \
439 	WPCM450_GRP(fi4), \
440 	WPCM450_GRP(fi5), \
441 	WPCM450_GRP(fi6), \
442 	WPCM450_GRP(fi7), \
443 	WPCM450_GRP(fi8), \
444 	WPCM450_GRP(fi9), \
445 	WPCM450_GRP(fi10), \
446 	WPCM450_GRP(fi11), \
447 	WPCM450_GRP(fi12), \
448 	WPCM450_GRP(fi13), \
449 	WPCM450_GRP(fi14), \
450 	WPCM450_GRP(fi15), \
451 	WPCM450_GRP(pwm0), \
452 	WPCM450_GRP(pwm1), \
453 	WPCM450_GRP(pwm2), \
454 	WPCM450_GRP(pwm3), \
455 	WPCM450_GRP(pwm4), \
456 	WPCM450_GRP(pwm5), \
457 	WPCM450_GRP(pwm6), \
458 	WPCM450_GRP(pwm7), \
459 	WPCM450_GRP(hg0), \
460 	WPCM450_GRP(hg1), \
461 	WPCM450_GRP(hg2), \
462 	WPCM450_GRP(hg3), \
463 	WPCM450_GRP(hg4), \
464 	WPCM450_GRP(hg5), \
465 	WPCM450_GRP(hg6), \
466 	WPCM450_GRP(hg7), \
467 
468 enum {
469 #define WPCM450_GRP(x) fn_ ## x
470 	WPCM450_GRPS
471 	/* add placeholder for none/gpio */
472 	WPCM450_GRP(gpio),
473 	WPCM450_GRP(none),
474 #undef WPCM450_GRP
475 };
476 
477 static struct group_desc wpcm450_groups[] = {
478 #define WPCM450_GRP(x) { .name = #x, .pins = x ## _pins, \
479 			.num_pins = ARRAY_SIZE(x ## _pins) }
480 	WPCM450_GRPS
481 #undef WPCM450_GRP
482 };
483 
484 #define WPCM450_SFUNC(a) WPCM450_FUNC(a, #a)
485 #define WPCM450_FUNC(a, b...) static const char *a ## _grp[] = { b }
486 #define WPCM450_MKFUNC(nm) { .name = #nm, .ngroups = ARRAY_SIZE(nm ## _grp), \
487 			.groups = nm ## _grp }
488 struct wpcm450_func {
489 	const char *name;
490 	const unsigned int ngroups;
491 	const char *const *groups;
492 };
493 
494 WPCM450_SFUNC(smb3);
495 WPCM450_SFUNC(smb4);
496 WPCM450_SFUNC(smb5);
497 WPCM450_SFUNC(scs1);
498 WPCM450_SFUNC(scs2);
499 WPCM450_SFUNC(scs3);
500 WPCM450_SFUNC(smb0);
501 WPCM450_SFUNC(smb1);
502 WPCM450_SFUNC(smb2);
503 WPCM450_SFUNC(bsp);
504 WPCM450_SFUNC(hsp1);
505 WPCM450_SFUNC(hsp2);
506 WPCM450_SFUNC(r1err);
507 WPCM450_SFUNC(r1md);
508 WPCM450_SFUNC(rmii2);
509 WPCM450_SFUNC(r2err);
510 WPCM450_SFUNC(r2md);
511 WPCM450_SFUNC(kbcc);
512 WPCM450_SFUNC(clko);
513 WPCM450_SFUNC(smi);
514 WPCM450_SFUNC(uinc);
515 WPCM450_SFUNC(gspi);
516 WPCM450_SFUNC(mben);
517 WPCM450_SFUNC(xcs2);
518 WPCM450_SFUNC(xcs1);
519 WPCM450_SFUNC(sdio);
520 WPCM450_SFUNC(sspi);
521 WPCM450_SFUNC(fi0);
522 WPCM450_SFUNC(fi1);
523 WPCM450_SFUNC(fi2);
524 WPCM450_SFUNC(fi3);
525 WPCM450_SFUNC(fi4);
526 WPCM450_SFUNC(fi5);
527 WPCM450_SFUNC(fi6);
528 WPCM450_SFUNC(fi7);
529 WPCM450_SFUNC(fi8);
530 WPCM450_SFUNC(fi9);
531 WPCM450_SFUNC(fi10);
532 WPCM450_SFUNC(fi11);
533 WPCM450_SFUNC(fi12);
534 WPCM450_SFUNC(fi13);
535 WPCM450_SFUNC(fi14);
536 WPCM450_SFUNC(fi15);
537 WPCM450_SFUNC(pwm0);
538 WPCM450_SFUNC(pwm1);
539 WPCM450_SFUNC(pwm2);
540 WPCM450_SFUNC(pwm3);
541 WPCM450_SFUNC(pwm4);
542 WPCM450_SFUNC(pwm5);
543 WPCM450_SFUNC(pwm6);
544 WPCM450_SFUNC(pwm7);
545 WPCM450_SFUNC(hg0);
546 WPCM450_SFUNC(hg1);
547 WPCM450_SFUNC(hg2);
548 WPCM450_SFUNC(hg3);
549 WPCM450_SFUNC(hg4);
550 WPCM450_SFUNC(hg5);
551 WPCM450_SFUNC(hg6);
552 WPCM450_SFUNC(hg7);
553 
554 #define WPCM450_GRP(x) #x
555 WPCM450_FUNC(gpio, WPCM450_GRPS);
556 #undef WPCM450_GRP
557 
558 /* Function names */
559 static struct wpcm450_func wpcm450_funcs[] = {
560 	WPCM450_MKFUNC(smb3),
561 	WPCM450_MKFUNC(smb4),
562 	WPCM450_MKFUNC(smb5),
563 	WPCM450_MKFUNC(scs1),
564 	WPCM450_MKFUNC(scs2),
565 	WPCM450_MKFUNC(scs3),
566 	WPCM450_MKFUNC(smb0),
567 	WPCM450_MKFUNC(smb1),
568 	WPCM450_MKFUNC(smb2),
569 	WPCM450_MKFUNC(bsp),
570 	WPCM450_MKFUNC(hsp1),
571 	WPCM450_MKFUNC(hsp2),
572 	WPCM450_MKFUNC(r1err),
573 	WPCM450_MKFUNC(r1md),
574 	WPCM450_MKFUNC(rmii2),
575 	WPCM450_MKFUNC(r2err),
576 	WPCM450_MKFUNC(r2md),
577 	WPCM450_MKFUNC(kbcc),
578 	WPCM450_MKFUNC(clko),
579 	WPCM450_MKFUNC(smi),
580 	WPCM450_MKFUNC(uinc),
581 	WPCM450_MKFUNC(gspi),
582 	WPCM450_MKFUNC(mben),
583 	WPCM450_MKFUNC(xcs2),
584 	WPCM450_MKFUNC(xcs1),
585 	WPCM450_MKFUNC(sdio),
586 	WPCM450_MKFUNC(sspi),
587 	WPCM450_MKFUNC(fi0),
588 	WPCM450_MKFUNC(fi1),
589 	WPCM450_MKFUNC(fi2),
590 	WPCM450_MKFUNC(fi3),
591 	WPCM450_MKFUNC(fi4),
592 	WPCM450_MKFUNC(fi5),
593 	WPCM450_MKFUNC(fi6),
594 	WPCM450_MKFUNC(fi7),
595 	WPCM450_MKFUNC(fi8),
596 	WPCM450_MKFUNC(fi9),
597 	WPCM450_MKFUNC(fi10),
598 	WPCM450_MKFUNC(fi11),
599 	WPCM450_MKFUNC(fi12),
600 	WPCM450_MKFUNC(fi13),
601 	WPCM450_MKFUNC(fi14),
602 	WPCM450_MKFUNC(fi15),
603 	WPCM450_MKFUNC(pwm0),
604 	WPCM450_MKFUNC(pwm1),
605 	WPCM450_MKFUNC(pwm2),
606 	WPCM450_MKFUNC(pwm3),
607 	WPCM450_MKFUNC(pwm4),
608 	WPCM450_MKFUNC(pwm5),
609 	WPCM450_MKFUNC(pwm6),
610 	WPCM450_MKFUNC(pwm7),
611 	WPCM450_MKFUNC(hg0),
612 	WPCM450_MKFUNC(hg1),
613 	WPCM450_MKFUNC(hg2),
614 	WPCM450_MKFUNC(hg3),
615 	WPCM450_MKFUNC(hg4),
616 	WPCM450_MKFUNC(hg5),
617 	WPCM450_MKFUNC(hg6),
618 	WPCM450_MKFUNC(hg7),
619 	WPCM450_MKFUNC(gpio),
620 };
621 
622 #define WPCM450_PINCFG(a, b, c, d, e, f, g) \
623 	[a] = { .fn0 = fn_ ## b, .reg0 = WPCM450_GCR_ ## c, .bit0 = d, \
624 	        .fn1 = fn_ ## e, .reg1 = WPCM450_GCR_ ## f, .bit1 = g }
625 
626 struct wpcm450_pincfg {
627 	int fn0, reg0, bit0;
628 	int fn1, reg1, bit1;
629 };
630 
631 /* Add this value to bit0 or bit1 to indicate that the MFSEL bit is inverted */
632 #define INV	BIT(5)
633 
634 static const struct wpcm450_pincfg pincfg[] = {
635 	/*		PIN	  FUNCTION 1		   FUNCTION 2 */
636 	WPCM450_PINCFG(0,	 none, NONE, 0,		  none, NONE, 0),
637 	WPCM450_PINCFG(1,	 none, NONE, 0,		  none, NONE, 0),
638 	WPCM450_PINCFG(2,	 none, NONE, 0,		  none, NONE, 0),
639 	WPCM450_PINCFG(3,	 none, NONE, 0,		  none, NONE, 0),
640 	WPCM450_PINCFG(4,	 none, NONE, 0,		  none, NONE, 0),
641 	WPCM450_PINCFG(5,	 none, NONE, 0,		  none, NONE, 0),
642 	WPCM450_PINCFG(6,	 none, NONE, 0,		  none, NONE, 0),
643 	WPCM450_PINCFG(7,	 none, NONE, 0,		  sdio, MFSEL1, 30),
644 	WPCM450_PINCFG(8,	 none, NONE, 0,		  none, NONE, 0),
645 	WPCM450_PINCFG(9,	 none, NONE, 0,		  none, NONE, 0),
646 	WPCM450_PINCFG(10,	 none, NONE, 0,		  none, NONE, 0),
647 	WPCM450_PINCFG(11,	 none, NONE, 0,		  none, NONE, 0),
648 	WPCM450_PINCFG(12,	 gspi, MFSEL1, 24,	  sspi, MFSEL1, 31),
649 	WPCM450_PINCFG(13,	 gspi, MFSEL1, 24,	  sspi, MFSEL1, 31),
650 	WPCM450_PINCFG(14,	 gspi, MFSEL1, 24,	  sspi, MFSEL1, 31),
651 	WPCM450_PINCFG(15,	 gspi, MFSEL1, 24,	  sspi, MFSEL1, 31),
652 	WPCM450_PINCFG(16,	 none, NONE, 0,		  pwm6, MFSEL2, 22),
653 	WPCM450_PINCFG(17,	 none, NONE, 0,		  pwm7, MFSEL2, 23),
654 	WPCM450_PINCFG(18,	 none, NONE, 0,		  none, NONE, 0),
655 	WPCM450_PINCFG(19,	 uinc, MFSEL1, 23,	  none, NONE, 0),
656 	WPCM450_PINCFG(20,	  hg0, MFSEL2, 24,	  pwm4, MFSEL2, 20),
657 	WPCM450_PINCFG(21,	  hg1, MFSEL2, 25,	  pwm5, MFSEL2, 21),
658 	WPCM450_PINCFG(22,	  hg2, MFSEL2, 26,	  none, NONE, 0),
659 	WPCM450_PINCFG(23,	  hg3, MFSEL2, 27,	  none, NONE, 0),
660 	WPCM450_PINCFG(24,	  hg4, MFSEL2, 28,	  none, NONE, 0),
661 	WPCM450_PINCFG(25,	  hg5, MFSEL2, 29,	  none, NONE, 0),
662 	WPCM450_PINCFG(26,	 smb5, MFSEL1, 2,	  none, NONE, 0),
663 	WPCM450_PINCFG(27,	 smb5, MFSEL1, 2,	  none, NONE, 0),
664 	WPCM450_PINCFG(28,	 smb4, MFSEL1, 1,	  none, NONE, 0),
665 	WPCM450_PINCFG(29,	 smb4, MFSEL1, 1,	  none, NONE, 0),
666 	WPCM450_PINCFG(30,	 smb3, MFSEL1, 0,	  none, NONE, 0),
667 	WPCM450_PINCFG(31,	 smb3, MFSEL1, 0,	  none, NONE, 0),
668 
669 	WPCM450_PINCFG(32,	 scs1, MFSEL1, 3,	  none, NONE, 0),
670 	WPCM450_PINCFG(33,	 scs2, MFSEL1, 4,	  none, NONE, 0),
671 	WPCM450_PINCFG(34,	 scs3, MFSEL1, 5 | INV,	  none, NONE, 0),
672 	WPCM450_PINCFG(35,	 xcs1, MFSEL1, 29,	  none, NONE, 0),
673 	WPCM450_PINCFG(36,	 xcs2, MFSEL1, 28,	  none, NONE, 0),
674 	WPCM450_PINCFG(37,	 none, NONE, 0,		  none, NONE, 0), /* DVO */
675 	WPCM450_PINCFG(38,	 none, NONE, 0,		  none, NONE, 0), /* DVO */
676 	WPCM450_PINCFG(39,	 none, NONE, 0,		  none, NONE, 0), /* DVO */
677 	WPCM450_PINCFG(40,	 none, NONE, 0,		  none, NONE, 0), /* DVO */
678 	WPCM450_PINCFG(41,	  bsp, MFSEL1, 9,	  none, NONE, 0),
679 	WPCM450_PINCFG(42,	  bsp, MFSEL1, 9,	  none, NONE, 0),
680 	WPCM450_PINCFG(43,	 hsp1, MFSEL1, 10,	  sdio, MFSEL1, 30),
681 	WPCM450_PINCFG(44,	 hsp1, MFSEL1, 10,	  sdio, MFSEL1, 30),
682 	WPCM450_PINCFG(45,	 hsp1, MFSEL1, 10,	  sdio, MFSEL1, 30),
683 	WPCM450_PINCFG(46,	 hsp1, MFSEL1, 10,	  sdio, MFSEL1, 30),
684 	WPCM450_PINCFG(47,	 hsp1, MFSEL1, 10,	  sdio, MFSEL1, 30),
685 	WPCM450_PINCFG(48,	 hsp2, MFSEL1, 11,	  none, NONE, 0),
686 	WPCM450_PINCFG(49,	 hsp2, MFSEL1, 11,	  none, NONE, 0),
687 	WPCM450_PINCFG(50,	 hsp2, MFSEL1, 11,	  none, NONE, 0),
688 	WPCM450_PINCFG(51,	 hsp2, MFSEL1, 11,	  none, NONE, 0),
689 	WPCM450_PINCFG(52,	 hsp2, MFSEL1, 11,	  none, NONE, 0),
690 	WPCM450_PINCFG(53,	 hsp2, MFSEL1, 11,	  none, NONE, 0),
691 	WPCM450_PINCFG(54,	 hsp2, MFSEL1, 11,	  none, NONE, 0),
692 	WPCM450_PINCFG(55,	 hsp2, MFSEL1, 11,	  none, NONE, 0),
693 	WPCM450_PINCFG(56,	r1err, MFSEL1, 12,	  none, NONE, 0),
694 	WPCM450_PINCFG(57,	 r1md, MFSEL1, 13,	  none, NONE, 0),
695 	WPCM450_PINCFG(58,	 r1md, MFSEL1, 13,	  none, NONE, 0),
696 	WPCM450_PINCFG(59,	  hg6, MFSEL2, 30,	  none, NONE, 0),
697 	WPCM450_PINCFG(60,	  hg7, MFSEL2, 31,	  sdio, MFSEL1, 30),
698 	WPCM450_PINCFG(61,	 hsp1, MFSEL1, 10,	  none, NONE, 0),
699 	WPCM450_PINCFG(62,	 hsp1, MFSEL1, 10,	  none, NONE, 0),
700 	WPCM450_PINCFG(63,	 hsp1, MFSEL1, 10,	  none, NONE, 0),
701 
702 	WPCM450_PINCFG(64,	  fi0, MFSEL2, 0,	  none, NONE, 0),
703 	WPCM450_PINCFG(65,	  fi1, MFSEL2, 1,	  none, NONE, 0),
704 	WPCM450_PINCFG(66,	  fi2, MFSEL2, 2,	  none, NONE, 0),
705 	WPCM450_PINCFG(67,	  fi3, MFSEL2, 3,	  none, NONE, 0),
706 	WPCM450_PINCFG(68,	  fi4, MFSEL2, 4,	  none, NONE, 0),
707 	WPCM450_PINCFG(69,	  fi5, MFSEL2, 5,	  none, NONE, 0),
708 	WPCM450_PINCFG(70,	  fi6, MFSEL2, 6,	  none, NONE, 0),
709 	WPCM450_PINCFG(71,	  fi7, MFSEL2, 7,	  none, NONE, 0),
710 	WPCM450_PINCFG(72,	  fi8, MFSEL2, 8,	  none, NONE, 0),
711 	WPCM450_PINCFG(73,	  fi9, MFSEL2, 9,	  none, NONE, 0),
712 	WPCM450_PINCFG(74,	 fi10, MFSEL2, 10,	  none, NONE, 0),
713 	WPCM450_PINCFG(75,	 fi11, MFSEL2, 11,	  none, NONE, 0),
714 	WPCM450_PINCFG(76,	 fi12, MFSEL2, 12,	  none, NONE, 0),
715 	WPCM450_PINCFG(77,	 fi13, MFSEL2, 13,	  none, NONE, 0),
716 	WPCM450_PINCFG(78,	 fi14, MFSEL2, 14,	  none, NONE, 0),
717 	WPCM450_PINCFG(79,	 fi15, MFSEL2, 15,	  none, NONE, 0),
718 	WPCM450_PINCFG(80,	 pwm0, MFSEL2, 16,	  none, NONE, 0),
719 	WPCM450_PINCFG(81,	 pwm1, MFSEL2, 17,	  none, NONE, 0),
720 	WPCM450_PINCFG(82,	 pwm2, MFSEL2, 18,	  none, NONE, 0),
721 	WPCM450_PINCFG(83,	 pwm3, MFSEL2, 19,	  none, NONE, 0),
722 	WPCM450_PINCFG(84,	rmii2, MFSEL1, 14,	  none, NONE, 0),
723 	WPCM450_PINCFG(85,	rmii2, MFSEL1, 14,	  none, NONE, 0),
724 	WPCM450_PINCFG(86,	rmii2, MFSEL1, 14,	  none, NONE, 0),
725 	WPCM450_PINCFG(87,	rmii2, MFSEL1, 14,	  none, NONE, 0),
726 	WPCM450_PINCFG(88,	rmii2, MFSEL1, 14,	  none, NONE, 0),
727 	WPCM450_PINCFG(89,	rmii2, MFSEL1, 14,	  none, NONE, 0),
728 	WPCM450_PINCFG(90,	r2err, MFSEL1, 15,	  none, NONE, 0),
729 	WPCM450_PINCFG(91,	 r2md, MFSEL1, 16,	  none, NONE, 0),
730 	WPCM450_PINCFG(92,	 r2md, MFSEL1, 16,	  none, NONE, 0),
731 	WPCM450_PINCFG(93,	 kbcc, MFSEL1, 17 | INV,  none, NONE, 0),
732 	WPCM450_PINCFG(94,	 kbcc, MFSEL1, 17 | INV,  none, NONE, 0),
733 	WPCM450_PINCFG(95,	 none, NONE, 0,		  none, NONE, 0),
734 
735 	WPCM450_PINCFG(96,	 none, NONE, 0,		  none, NONE, 0),
736 	WPCM450_PINCFG(97,	 none, NONE, 0,		  none, NONE, 0),
737 	WPCM450_PINCFG(98,	 none, NONE, 0,		  none, NONE, 0),
738 	WPCM450_PINCFG(99,	 none, NONE, 0,		  none, NONE, 0),
739 	WPCM450_PINCFG(100,	 none, NONE, 0,		  none, NONE, 0),
740 	WPCM450_PINCFG(101,	 none, NONE, 0,		  none, NONE, 0),
741 	WPCM450_PINCFG(102,	 none, NONE, 0,		  none, NONE, 0),
742 	WPCM450_PINCFG(103,	 none, NONE, 0,		  none, NONE, 0),
743 	WPCM450_PINCFG(104,	 none, NONE, 0,		  none, NONE, 0),
744 	WPCM450_PINCFG(105,	 none, NONE, 0,		  none, NONE, 0),
745 	WPCM450_PINCFG(106,	 none, NONE, 0,		  none, NONE, 0),
746 	WPCM450_PINCFG(107,	 none, NONE, 0,		  none, NONE, 0),
747 	WPCM450_PINCFG(108,	 none, NONE, 0,		  none, NONE, 0), /* DVO */
748 	WPCM450_PINCFG(109,	 none, NONE, 0,		  none, NONE, 0), /* DVO */
749 	WPCM450_PINCFG(110,	 none, NONE, 0,		  none, NONE, 0), /* DVO */
750 	WPCM450_PINCFG(111,	 none, NONE, 0,		  none, NONE, 0), /* DVO */
751 	WPCM450_PINCFG(112,	 none, NONE, 0,		  none, NONE, 0), /* DVO */
752 	WPCM450_PINCFG(113,	 none, NONE, 0,		  none, NONE, 0), /* DVO */
753 	WPCM450_PINCFG(114,	 smb0, MFSEL1, 6,	  none, NONE, 0),
754 	WPCM450_PINCFG(115,	 smb0, MFSEL1, 6,	  none, NONE, 0),
755 	WPCM450_PINCFG(116,	 smb1, MFSEL1, 7,	  none, NONE, 0),
756 	WPCM450_PINCFG(117,	 smb1, MFSEL1, 7,	  none, NONE, 0),
757 	WPCM450_PINCFG(118,	 smb2, MFSEL1, 8,	  none, NONE, 0),
758 	WPCM450_PINCFG(119,	 smb2, MFSEL1, 8,	  none, NONE, 0),
759 	WPCM450_PINCFG(120,	 none, NONE, 0,		  none, NONE, 0), /* DVO */
760 	WPCM450_PINCFG(121,	 none, NONE, 0,		  none, NONE, 0), /* DVO */
761 	WPCM450_PINCFG(122,	 none, NONE, 0,		  none, NONE, 0), /* DVO */
762 	WPCM450_PINCFG(123,	 none, NONE, 0,		  none, NONE, 0), /* DVO */
763 	WPCM450_PINCFG(124,	 none, NONE, 0,		  none, NONE, 0), /* DVO */
764 	WPCM450_PINCFG(125,	 none, NONE, 0,		  none, NONE, 0), /* DVO */
765 	WPCM450_PINCFG(126,	 none, NONE, 0,		  none, NONE, 0), /* DVO */
766 	WPCM450_PINCFG(127,	 none, NONE, 0,		  none, NONE, 0), /* DVO */
767 };
768 
769 #define WPCM450_PIN(n)		PINCTRL_PIN(n, "gpio" #n)
770 
771 static const struct pinctrl_pin_desc wpcm450_pins[] = {
772 	WPCM450_PIN(0),   WPCM450_PIN(1),   WPCM450_PIN(2),   WPCM450_PIN(3),
773 	WPCM450_PIN(4),   WPCM450_PIN(5),   WPCM450_PIN(6),   WPCM450_PIN(7),
774 	WPCM450_PIN(8),   WPCM450_PIN(9),   WPCM450_PIN(10),  WPCM450_PIN(11),
775 	WPCM450_PIN(12),  WPCM450_PIN(13),  WPCM450_PIN(14),  WPCM450_PIN(15),
776 	WPCM450_PIN(16),  WPCM450_PIN(17),  WPCM450_PIN(18),  WPCM450_PIN(19),
777 	WPCM450_PIN(20),  WPCM450_PIN(21),  WPCM450_PIN(22),  WPCM450_PIN(23),
778 	WPCM450_PIN(24),  WPCM450_PIN(25),  WPCM450_PIN(26),  WPCM450_PIN(27),
779 	WPCM450_PIN(28),  WPCM450_PIN(29),  WPCM450_PIN(30),  WPCM450_PIN(31),
780 	WPCM450_PIN(32),  WPCM450_PIN(33),  WPCM450_PIN(34),  WPCM450_PIN(35),
781 	WPCM450_PIN(36),  WPCM450_PIN(37),  WPCM450_PIN(38),  WPCM450_PIN(39),
782 	WPCM450_PIN(40),  WPCM450_PIN(41),  WPCM450_PIN(42),  WPCM450_PIN(43),
783 	WPCM450_PIN(44),  WPCM450_PIN(45),  WPCM450_PIN(46),  WPCM450_PIN(47),
784 	WPCM450_PIN(48),  WPCM450_PIN(49),  WPCM450_PIN(50),  WPCM450_PIN(51),
785 	WPCM450_PIN(52),  WPCM450_PIN(53),  WPCM450_PIN(54),  WPCM450_PIN(55),
786 	WPCM450_PIN(56),  WPCM450_PIN(57),  WPCM450_PIN(58),  WPCM450_PIN(59),
787 	WPCM450_PIN(60),  WPCM450_PIN(61),  WPCM450_PIN(62),  WPCM450_PIN(63),
788 	WPCM450_PIN(64),  WPCM450_PIN(65),  WPCM450_PIN(66),  WPCM450_PIN(67),
789 	WPCM450_PIN(68),  WPCM450_PIN(69),  WPCM450_PIN(70),  WPCM450_PIN(71),
790 	WPCM450_PIN(72),  WPCM450_PIN(73),  WPCM450_PIN(74),  WPCM450_PIN(75),
791 	WPCM450_PIN(76),  WPCM450_PIN(77),  WPCM450_PIN(78),  WPCM450_PIN(79),
792 	WPCM450_PIN(80),  WPCM450_PIN(81),  WPCM450_PIN(82),  WPCM450_PIN(83),
793 	WPCM450_PIN(84),  WPCM450_PIN(85),  WPCM450_PIN(86),  WPCM450_PIN(87),
794 	WPCM450_PIN(88),  WPCM450_PIN(89),  WPCM450_PIN(90),  WPCM450_PIN(91),
795 	WPCM450_PIN(92),  WPCM450_PIN(93),  WPCM450_PIN(94),  WPCM450_PIN(95),
796 	WPCM450_PIN(96),  WPCM450_PIN(97),  WPCM450_PIN(98),  WPCM450_PIN(99),
797 	WPCM450_PIN(100), WPCM450_PIN(101), WPCM450_PIN(102), WPCM450_PIN(103),
798 	WPCM450_PIN(104), WPCM450_PIN(105), WPCM450_PIN(106), WPCM450_PIN(107),
799 	WPCM450_PIN(108), WPCM450_PIN(109), WPCM450_PIN(110), WPCM450_PIN(111),
800 	WPCM450_PIN(112), WPCM450_PIN(113), WPCM450_PIN(114), WPCM450_PIN(115),
801 	WPCM450_PIN(116), WPCM450_PIN(117), WPCM450_PIN(118), WPCM450_PIN(119),
802 	WPCM450_PIN(120), WPCM450_PIN(121), WPCM450_PIN(122), WPCM450_PIN(123),
803 	WPCM450_PIN(124), WPCM450_PIN(125), WPCM450_PIN(126), WPCM450_PIN(127),
804 };
805 
806 /* Helper function to update MFSEL field according to the selected function */
wpcm450_update_mfsel(struct regmap * gcr_regmap,int reg,int bit,int fn,int fn_selected)807 static void wpcm450_update_mfsel(struct regmap *gcr_regmap, int reg, int bit, int fn, int fn_selected)
808 {
809 	bool value = (fn == fn_selected);
810 
811 	if (bit & INV) {
812 		value = !value;
813 		bit &= ~INV;
814 	}
815 
816 	regmap_update_bits(gcr_regmap, reg, BIT(bit), value ? BIT(bit) : 0);
817 }
818 
819 /* Enable mode in pin group */
wpcm450_setfunc(struct regmap * gcr_regmap,const unsigned int * pin,int npins,int func)820 static void wpcm450_setfunc(struct regmap *gcr_regmap, const unsigned int *pin,
821 			    int npins, int func)
822 {
823 	const struct wpcm450_pincfg *cfg;
824 	int i;
825 
826 	for (i = 0; i < npins; i++) {
827 		cfg = &pincfg[pin[i]];
828 		if (func == fn_gpio || cfg->fn0 == func || cfg->fn1 == func) {
829 			if (cfg->reg0)
830 				wpcm450_update_mfsel(gcr_regmap, cfg->reg0,
831 						     cfg->bit0, cfg->fn0, func);
832 			if (cfg->reg1)
833 				wpcm450_update_mfsel(gcr_regmap, cfg->reg1,
834 						     cfg->bit1, cfg->fn1, func);
835 		}
836 	}
837 }
838 
wpcm450_get_groups_count(struct pinctrl_dev * pctldev)839 static int wpcm450_get_groups_count(struct pinctrl_dev *pctldev)
840 {
841 	return ARRAY_SIZE(wpcm450_groups);
842 }
843 
wpcm450_get_group_name(struct pinctrl_dev * pctldev,unsigned int selector)844 static const char *wpcm450_get_group_name(struct pinctrl_dev *pctldev,
845 					  unsigned int selector)
846 {
847 	return wpcm450_groups[selector].name;
848 }
849 
wpcm450_get_group_pins(struct pinctrl_dev * pctldev,unsigned int selector,const unsigned int ** pins,unsigned int * npins)850 static int wpcm450_get_group_pins(struct pinctrl_dev *pctldev,
851 				  unsigned int selector,
852 				  const unsigned int **pins,
853 				  unsigned int *npins)
854 {
855 	*npins = wpcm450_groups[selector].num_pins;
856 	*pins  = wpcm450_groups[selector].pins;
857 
858 	return 0;
859 }
860 
wpcm450_dt_node_to_map(struct pinctrl_dev * pctldev,struct device_node * np_config,struct pinctrl_map ** map,u32 * num_maps)861 static int wpcm450_dt_node_to_map(struct pinctrl_dev *pctldev,
862 				  struct device_node *np_config,
863 				  struct pinctrl_map **map,
864 				  u32 *num_maps)
865 {
866 	return pinconf_generic_dt_node_to_map(pctldev, np_config,
867 					      map, num_maps,
868 					      PIN_MAP_TYPE_INVALID);
869 }
870 
wpcm450_dt_free_map(struct pinctrl_dev * pctldev,struct pinctrl_map * map,u32 num_maps)871 static void wpcm450_dt_free_map(struct pinctrl_dev *pctldev,
872 				struct pinctrl_map *map, u32 num_maps)
873 {
874 	kfree(map);
875 }
876 
877 static const struct pinctrl_ops wpcm450_pinctrl_ops = {
878 	.get_groups_count = wpcm450_get_groups_count,
879 	.get_group_name = wpcm450_get_group_name,
880 	.get_group_pins = wpcm450_get_group_pins,
881 	.dt_node_to_map = wpcm450_dt_node_to_map,
882 	.dt_free_map = wpcm450_dt_free_map,
883 };
884 
wpcm450_get_functions_count(struct pinctrl_dev * pctldev)885 static int wpcm450_get_functions_count(struct pinctrl_dev *pctldev)
886 {
887 	return ARRAY_SIZE(wpcm450_funcs);
888 }
889 
wpcm450_get_function_name(struct pinctrl_dev * pctldev,unsigned int function)890 static const char *wpcm450_get_function_name(struct pinctrl_dev *pctldev,
891 					     unsigned int function)
892 {
893 	return wpcm450_funcs[function].name;
894 }
895 
wpcm450_get_function_groups(struct pinctrl_dev * pctldev,unsigned int function,const char * const ** groups,unsigned int * const ngroups)896 static int wpcm450_get_function_groups(struct pinctrl_dev *pctldev,
897 				       unsigned int function,
898 				       const char * const **groups,
899 				       unsigned int * const ngroups)
900 {
901 	*ngroups = wpcm450_funcs[function].ngroups;
902 	*groups	 = wpcm450_funcs[function].groups;
903 
904 	return 0;
905 }
906 
wpcm450_pinmux_set_mux(struct pinctrl_dev * pctldev,unsigned int function,unsigned int group)907 static int wpcm450_pinmux_set_mux(struct pinctrl_dev *pctldev,
908 				  unsigned int function,
909 				  unsigned int group)
910 {
911 	struct wpcm450_pinctrl *pctrl = pinctrl_dev_get_drvdata(pctldev);
912 
913 	wpcm450_setfunc(pctrl->gcr_regmap, wpcm450_groups[group].pins,
914 			wpcm450_groups[group].num_pins, function);
915 
916 	return 0;
917 }
918 
919 static const struct pinmux_ops wpcm450_pinmux_ops = {
920 	.get_functions_count = wpcm450_get_functions_count,
921 	.get_function_name = wpcm450_get_function_name,
922 	.get_function_groups = wpcm450_get_function_groups,
923 	.set_mux = wpcm450_pinmux_set_mux,
924 };
925 
debounce_bitnum(int gpio)926 static int debounce_bitnum(int gpio)
927 {
928 	if (gpio >= 0 && gpio < 16)
929 		return gpio;
930 	return -EINVAL;
931 }
932 
wpcm450_config_get(struct pinctrl_dev * pctldev,unsigned int pin,unsigned long * config)933 static int wpcm450_config_get(struct pinctrl_dev *pctldev, unsigned int pin,
934 			      unsigned long *config)
935 {
936 	struct wpcm450_pinctrl *pctrl = pinctrl_dev_get_drvdata(pctldev);
937 	enum pin_config_param param = pinconf_to_config_param(*config);
938 	unsigned long flags;
939 	int bit;
940 	u32 reg;
941 
942 	switch (param) {
943 	case PIN_CONFIG_INPUT_DEBOUNCE:
944 		bit = debounce_bitnum(pin);
945 		if (bit < 0)
946 			return bit;
947 
948 		raw_spin_lock_irqsave(&pctrl->lock, flags);
949 		reg = ioread32(pctrl->gpio_base + WPCM450_GPEVDBNC);
950 		raw_spin_unlock_irqrestore(&pctrl->lock, flags);
951 
952 		*config = pinconf_to_config_packed(param, !!(reg & BIT(bit)));
953 		return 0;
954 	default:
955 		return -ENOTSUPP;
956 	}
957 }
958 
wpcm450_config_set_one(struct wpcm450_pinctrl * pctrl,unsigned int pin,unsigned long config)959 static int wpcm450_config_set_one(struct wpcm450_pinctrl *pctrl,
960 				  unsigned int pin, unsigned long config)
961 {
962 	enum pin_config_param param = pinconf_to_config_param(config);
963 	unsigned long flags;
964 	unsigned long reg;
965 	int bit;
966 	int arg;
967 
968 	switch (param) {
969 	case PIN_CONFIG_INPUT_DEBOUNCE:
970 		bit = debounce_bitnum(pin);
971 		if (bit < 0)
972 			return bit;
973 
974 		arg = pinconf_to_config_argument(config);
975 
976 		raw_spin_lock_irqsave(&pctrl->lock, flags);
977 		reg = ioread32(pctrl->gpio_base + WPCM450_GPEVDBNC);
978 		__assign_bit(bit, &reg, arg);
979 		iowrite32(reg, pctrl->gpio_base + WPCM450_GPEVDBNC);
980 		raw_spin_unlock_irqrestore(&pctrl->lock, flags);
981 		return 0;
982 	default:
983 		return -ENOTSUPP;
984 	}
985 }
986 
wpcm450_config_set(struct pinctrl_dev * pctldev,unsigned int pin,unsigned long * configs,unsigned int num_configs)987 static int wpcm450_config_set(struct pinctrl_dev *pctldev, unsigned int pin,
988 			      unsigned long *configs, unsigned int num_configs)
989 {
990 	struct wpcm450_pinctrl *pctrl = pinctrl_dev_get_drvdata(pctldev);
991 	int ret;
992 
993 	while (num_configs--) {
994 		ret = wpcm450_config_set_one(pctrl, pin, *configs++);
995 		if (ret)
996 			return ret;
997 	}
998 
999 	return 0;
1000 }
1001 
1002 static const struct pinconf_ops wpcm450_pinconf_ops = {
1003 	.is_generic = true,
1004 	.pin_config_get = wpcm450_config_get,
1005 	.pin_config_set = wpcm450_config_set,
1006 };
1007 
1008 static struct pinctrl_desc wpcm450_pinctrl_desc = {
1009 	.name = "wpcm450-pinctrl",
1010 	.pins = wpcm450_pins,
1011 	.npins = ARRAY_SIZE(wpcm450_pins),
1012 	.pctlops = &wpcm450_pinctrl_ops,
1013 	.pmxops = &wpcm450_pinmux_ops,
1014 	.confops = &wpcm450_pinconf_ops,
1015 	.owner = THIS_MODULE,
1016 };
1017 
wpcm450_gpio_set_config(struct gpio_chip * chip,unsigned int offset,unsigned long config)1018 static int wpcm450_gpio_set_config(struct gpio_chip *chip,
1019 				   unsigned int offset, unsigned long config)
1020 {
1021 	struct wpcm450_gpio *gpio = gpiochip_get_data(chip);
1022 
1023 	return wpcm450_config_set_one(gpio->pctrl, offset, config);
1024 }
1025 
wpcm450_gpio_add_pin_ranges(struct gpio_chip * chip)1026 static int wpcm450_gpio_add_pin_ranges(struct gpio_chip *chip)
1027 {
1028 	struct wpcm450_gpio *gpio = gpiochip_get_data(chip);
1029 	const struct wpcm450_bank *bank = gpio->bank;
1030 
1031 	return gpiochip_add_pin_range(&gpio->gc, dev_name(gpio->pctrl->dev),
1032 				      0, bank->base, bank->length);
1033 }
1034 
wpcm450_gpio_register(struct platform_device * pdev,struct wpcm450_pinctrl * pctrl)1035 static int wpcm450_gpio_register(struct platform_device *pdev,
1036 				 struct wpcm450_pinctrl *pctrl)
1037 {
1038 	struct device *dev = &pdev->dev;
1039 	struct fwnode_handle *child;
1040 	int ret;
1041 
1042 	pctrl->gpio_base = devm_platform_ioremap_resource(pdev, 0);
1043 	if (IS_ERR(pctrl->gpio_base))
1044 		return dev_err_probe(dev, PTR_ERR(pctrl->gpio_base),
1045 				     "Resource fail for GPIO controller\n");
1046 
1047 	device_for_each_child_node(dev, child)  {
1048 		void __iomem *dat = NULL;
1049 		void __iomem *set = NULL;
1050 		void __iomem *dirout = NULL;
1051 		unsigned long flags = 0;
1052 		const struct wpcm450_bank *bank;
1053 		struct wpcm450_gpio *gpio;
1054 		struct gpio_irq_chip *girq;
1055 		u32 reg;
1056 		int i;
1057 
1058 		if (!fwnode_property_read_bool(child, "gpio-controller"))
1059 			continue;
1060 
1061 		ret = fwnode_property_read_u32(child, "reg", &reg);
1062 		if (ret < 0)
1063 			return ret;
1064 
1065 		if (reg >= WPCM450_NUM_BANKS)
1066 			return dev_err_probe(dev, -EINVAL,
1067 					     "GPIO index %d out of range!\n", reg);
1068 
1069 		gpio = &pctrl->gpio_bank[reg];
1070 		gpio->pctrl = pctrl;
1071 
1072 		bank = &wpcm450_banks[reg];
1073 		gpio->bank = bank;
1074 
1075 		dat = pctrl->gpio_base + bank->datain;
1076 		if (bank->dataout) {
1077 			set = pctrl->gpio_base + bank->dataout;
1078 			dirout = pctrl->gpio_base + bank->cfg0;
1079 		} else {
1080 			flags = BGPIOF_NO_OUTPUT;
1081 		}
1082 		ret = bgpio_init(&gpio->gc, dev, 4,
1083 				 dat, set, NULL, dirout, NULL, flags);
1084 		if (ret < 0)
1085 			return dev_err_probe(dev, ret, "GPIO initialization failed\n");
1086 
1087 		gpio->gc.ngpio = bank->length;
1088 		gpio->gc.set_config = wpcm450_gpio_set_config;
1089 		gpio->gc.fwnode = child;
1090 		gpio->gc.add_pin_ranges = wpcm450_gpio_add_pin_ranges;
1091 
1092 		girq = &gpio->gc.irq;
1093 		gpio_irq_chip_set_chip(girq, &wpcm450_gpio_irqchip);
1094 		girq->parent_handler = wpcm450_gpio_irqhandler;
1095 		girq->parents = devm_kcalloc(dev, WPCM450_NUM_GPIO_IRQS,
1096 					     sizeof(*girq->parents), GFP_KERNEL);
1097 		if (!girq->parents)
1098 			return -ENOMEM;
1099 		girq->default_type = IRQ_TYPE_NONE;
1100 		girq->handler = handle_bad_irq;
1101 
1102 		girq->num_parents = 0;
1103 		for (i = 0; i < WPCM450_NUM_GPIO_IRQS; i++) {
1104 			int irq;
1105 
1106 			irq = fwnode_irq_get(child, i);
1107 			if (irq < 0)
1108 				break;
1109 			if (!irq)
1110 				continue;
1111 
1112 			girq->parents[i] = irq;
1113 			girq->num_parents++;
1114 		}
1115 
1116 		ret = devm_gpiochip_add_data(dev, &gpio->gc, gpio);
1117 		if (ret)
1118 			return dev_err_probe(dev, ret, "Failed to add GPIO chip\n");
1119 	}
1120 
1121 	return 0;
1122 }
1123 
wpcm450_pinctrl_probe(struct platform_device * pdev)1124 static int wpcm450_pinctrl_probe(struct platform_device *pdev)
1125 {
1126 	struct device *dev = &pdev->dev;
1127 	struct wpcm450_pinctrl *pctrl;
1128 	int ret;
1129 
1130 	pctrl = devm_kzalloc(dev, sizeof(*pctrl), GFP_KERNEL);
1131 	if (!pctrl)
1132 		return -ENOMEM;
1133 
1134 	pctrl->dev = &pdev->dev;
1135 	raw_spin_lock_init(&pctrl->lock);
1136 	dev_set_drvdata(dev, pctrl);
1137 
1138 	pctrl->gcr_regmap =
1139 		syscon_regmap_lookup_by_compatible("nuvoton,wpcm450-gcr");
1140 	if (IS_ERR(pctrl->gcr_regmap))
1141 		return dev_err_probe(dev, PTR_ERR(pctrl->gcr_regmap),
1142 				     "Failed to find nuvoton,wpcm450-gcr\n");
1143 
1144 	pctrl->pctldev = devm_pinctrl_register(dev,
1145 					       &wpcm450_pinctrl_desc, pctrl);
1146 	if (IS_ERR(pctrl->pctldev))
1147 		return dev_err_probe(dev, PTR_ERR(pctrl->pctldev),
1148 				     "Failed to register pinctrl device\n");
1149 
1150 	ret = wpcm450_gpio_register(pdev, pctrl);
1151 	if (ret < 0)
1152 		return ret;
1153 
1154 	return 0;
1155 }
1156 
1157 static const struct of_device_id wpcm450_pinctrl_match[] = {
1158 	{ .compatible = "nuvoton,wpcm450-pinctrl" },
1159 	{ }
1160 };
1161 MODULE_DEVICE_TABLE(of, wpcm450_pinctrl_match);
1162 
1163 static struct platform_driver wpcm450_pinctrl_driver = {
1164 	.probe = wpcm450_pinctrl_probe,
1165 	.driver = {
1166 		.name = "wpcm450-pinctrl",
1167 		.of_match_table = wpcm450_pinctrl_match,
1168 	},
1169 };
1170 module_platform_driver(wpcm450_pinctrl_driver);
1171 
1172 MODULE_LICENSE("GPL v2");
1173 MODULE_AUTHOR("Jonathan Neuschäfer <j.neuschaefer@gmx.net>");
1174 MODULE_DESCRIPTION("Nuvoton WPCM450 Pinctrl and GPIO driver");
1175