1 // SPDX-License-Identifier: GPL-2.0
2 /*
3  * MediaTek Pinctrl Paris Driver, which implement the vendor per-pin
4  * bindings for MediaTek SoC.
5  *
6  * Copyright (C) 2018 MediaTek Inc.
7  * Author: Sean Wang <sean.wang@mediatek.com>
8  *	   Zhiyong Tao <zhiyong.tao@mediatek.com>
9  *	   Hongzhou.Yang <hongzhou.yang@mediatek.com>
10  */
11 
12 #include <linux/gpio/driver.h>
13 #include <linux/module.h>
14 #include <linux/seq_file.h>
15 
16 #include <linux/pinctrl/consumer.h>
17 
18 #include <dt-bindings/pinctrl/mt65xx.h>
19 
20 #include "pinctrl-paris.h"
21 
22 #define PINCTRL_PINCTRL_DEV	KBUILD_MODNAME
23 
24 /* Custom pinconf parameters */
25 #define MTK_PIN_CONFIG_TDSEL	(PIN_CONFIG_END + 1)
26 #define MTK_PIN_CONFIG_RDSEL	(PIN_CONFIG_END + 2)
27 #define MTK_PIN_CONFIG_PU_ADV	(PIN_CONFIG_END + 3)
28 #define MTK_PIN_CONFIG_PD_ADV	(PIN_CONFIG_END + 4)
29 #define MTK_PIN_CONFIG_DRV_ADV	(PIN_CONFIG_END + 5)
30 
31 static const struct pinconf_generic_params mtk_custom_bindings[] = {
32 	{"mediatek,tdsel",	MTK_PIN_CONFIG_TDSEL,		0},
33 	{"mediatek,rdsel",	MTK_PIN_CONFIG_RDSEL,		0},
34 	{"mediatek,pull-up-adv", MTK_PIN_CONFIG_PU_ADV,		1},
35 	{"mediatek,pull-down-adv", MTK_PIN_CONFIG_PD_ADV,	1},
36 	{"mediatek,drive-strength-adv", MTK_PIN_CONFIG_DRV_ADV,	2},
37 };
38 
39 #ifdef CONFIG_DEBUG_FS
40 static const struct pin_config_item mtk_conf_items[] = {
41 	PCONFDUMP(MTK_PIN_CONFIG_TDSEL, "tdsel", NULL, true),
42 	PCONFDUMP(MTK_PIN_CONFIG_RDSEL, "rdsel", NULL, true),
43 	PCONFDUMP(MTK_PIN_CONFIG_PU_ADV, "pu-adv", NULL, true),
44 	PCONFDUMP(MTK_PIN_CONFIG_PD_ADV, "pd-adv", NULL, true),
45 	PCONFDUMP(MTK_PIN_CONFIG_DRV_ADV, "drive-strength-adv", NULL, true),
46 };
47 #endif
48 
49 static const char * const mtk_gpio_functions[] = {
50 	"func0", "func1", "func2", "func3",
51 	"func4", "func5", "func6", "func7",
52 	"func8", "func9", "func10", "func11",
53 	"func12", "func13", "func14", "func15",
54 };
55 
56 /*
57  * This section supports converting to/from custom MTK_PIN_CONFIG_DRV_ADV
58  * and standard PIN_CONFIG_DRIVE_STRENGTH_UA pin configs.
59  *
60  * The custom value encodes three hardware bits as follows:
61  *
62  *   |           Bits           |
63  *   | 2 (E1) | 1 (E0) | 0 (EN) | drive strength (uA)
64  *   ------------------------------------------------
65  *   |    x   |    x   |    0   | disabled, use standard drive strength
66  *   -------------------------------------
67  *   |    0   |    0   |    1   |  125 uA
68  *   |    0   |    1   |    1   |  250 uA
69  *   |    1   |    0   |    1   |  500 uA
70  *   |    1   |    1   |    1   | 1000 uA
71  */
72 static const int mtk_drv_adv_uA[] = { 125, 250, 500, 1000 };
73 
74 static int mtk_drv_adv_to_uA(int val)
75 {
76 	/* This should never happen. */
77 	if (WARN_ON_ONCE(val < 0 || val > 7))
78 		return -EINVAL;
79 
80 	/* Bit 0 simply enables this hardware part */
81 	if (!(val & BIT(0)))
82 		return -EINVAL;
83 
84 	return mtk_drv_adv_uA[(val >> 1)];
85 }
86 
87 static int mtk_drv_uA_to_adv(int val)
88 {
89 	switch (val) {
90 	case 125:
91 		return 0x1;
92 	case 250:
93 		return 0x3;
94 	case 500:
95 		return 0x5;
96 	case 1000:
97 		return 0x7;
98 	}
99 
100 	return -EINVAL;
101 }
102 
103 static int mtk_pinmux_gpio_request_enable(struct pinctrl_dev *pctldev,
104 					  struct pinctrl_gpio_range *range,
105 					  unsigned int pin)
106 {
107 	struct mtk_pinctrl *hw = pinctrl_dev_get_drvdata(pctldev);
108 	const struct mtk_pin_desc *desc;
109 
110 	desc = (const struct mtk_pin_desc *)&hw->soc->pins[pin];
111 
112 	return mtk_hw_set_value(hw, desc, PINCTRL_PIN_REG_MODE,
113 				hw->soc->gpio_m);
114 }
115 
116 static int mtk_pinmux_gpio_set_direction(struct pinctrl_dev *pctldev,
117 					 struct pinctrl_gpio_range *range,
118 					 unsigned int pin, bool input)
119 {
120 	struct mtk_pinctrl *hw = pinctrl_dev_get_drvdata(pctldev);
121 	const struct mtk_pin_desc *desc;
122 
123 	desc = (const struct mtk_pin_desc *)&hw->soc->pins[pin];
124 
125 	/* hardware would take 0 as input direction */
126 	return mtk_hw_set_value(hw, desc, PINCTRL_PIN_REG_DIR, !input);
127 }
128 
129 static int mtk_pinconf_get(struct pinctrl_dev *pctldev,
130 			   unsigned int pin, unsigned long *config)
131 {
132 	struct mtk_pinctrl *hw = pinctrl_dev_get_drvdata(pctldev);
133 	u32 param = pinconf_to_config_param(*config);
134 	int pullup, reg, err = -ENOTSUPP, ret = 1;
135 	const struct mtk_pin_desc *desc;
136 
137 	if (pin >= hw->soc->npins)
138 		return -EINVAL;
139 
140 	desc = (const struct mtk_pin_desc *)&hw->soc->pins[pin];
141 
142 	switch (param) {
143 	case PIN_CONFIG_BIAS_DISABLE:
144 	case PIN_CONFIG_BIAS_PULL_UP:
145 	case PIN_CONFIG_BIAS_PULL_DOWN:
146 		if (!hw->soc->bias_get_combo)
147 			break;
148 		err = hw->soc->bias_get_combo(hw, desc, &pullup, &ret);
149 		if (err)
150 			break;
151 		if (ret == MTK_PUPD_SET_R1R0_00)
152 			ret = MTK_DISABLE;
153 		if (param == PIN_CONFIG_BIAS_DISABLE) {
154 			if (ret != MTK_DISABLE)
155 				err = -EINVAL;
156 		} else if (param == PIN_CONFIG_BIAS_PULL_UP) {
157 			if (!pullup || ret == MTK_DISABLE)
158 				err = -EINVAL;
159 		} else if (param == PIN_CONFIG_BIAS_PULL_DOWN) {
160 			if (pullup || ret == MTK_DISABLE)
161 				err = -EINVAL;
162 		}
163 		break;
164 	case PIN_CONFIG_SLEW_RATE:
165 		err = mtk_hw_get_value(hw, desc, PINCTRL_PIN_REG_SR, &ret);
166 		break;
167 	case PIN_CONFIG_INPUT_ENABLE:
168 	case PIN_CONFIG_OUTPUT_ENABLE:
169 		err = mtk_hw_get_value(hw, desc, PINCTRL_PIN_REG_DIR, &ret);
170 		if (err)
171 			break;
172 		/*     CONFIG     Current direction return value
173 		 * -------------  ----------------- ----------------------
174 		 * OUTPUT_ENABLE       output       1 (= HW value)
175 		 *                     input        0 (= HW value)
176 		 * INPUT_ENABLE        output       0 (= reverse HW value)
177 		 *                     input        1 (= reverse HW value)
178 		 */
179 		if (param == PIN_CONFIG_INPUT_ENABLE)
180 			ret = !ret;
181 
182 		break;
183 	case PIN_CONFIG_INPUT_SCHMITT_ENABLE:
184 		err = mtk_hw_get_value(hw, desc, PINCTRL_PIN_REG_DIR, &ret);
185 		if (err)
186 			break;
187 		/* return error when in output mode
188 		 * because schmitt trigger only work in input mode
189 		 */
190 		if (ret) {
191 			err = -EINVAL;
192 			break;
193 		}
194 
195 		err = mtk_hw_get_value(hw, desc, PINCTRL_PIN_REG_SMT, &ret);
196 		break;
197 	case PIN_CONFIG_DRIVE_STRENGTH:
198 		if (!hw->soc->drive_get)
199 			break;
200 
201 		if (hw->soc->adv_drive_get) {
202 			err = hw->soc->adv_drive_get(hw, desc, &ret);
203 			if (!err) {
204 				err = mtk_drv_adv_to_uA(ret);
205 				if (err > 0) {
206 					/* PIN_CONFIG_DRIVE_STRENGTH_UA used */
207 					err = -EINVAL;
208 					break;
209 				}
210 			}
211 		}
212 
213 		err = hw->soc->drive_get(hw, desc, &ret);
214 		break;
215 	case PIN_CONFIG_DRIVE_STRENGTH_UA:
216 		if (!hw->soc->adv_drive_get)
217 			break;
218 
219 		err = hw->soc->adv_drive_get(hw, desc, &ret);
220 		if (err)
221 			break;
222 		err = mtk_drv_adv_to_uA(ret);
223 		if (err < 0)
224 			break;
225 
226 		ret = err;
227 		err = 0;
228 		break;
229 	case MTK_PIN_CONFIG_TDSEL:
230 	case MTK_PIN_CONFIG_RDSEL:
231 		reg = (param == MTK_PIN_CONFIG_TDSEL) ?
232 		       PINCTRL_PIN_REG_TDSEL : PINCTRL_PIN_REG_RDSEL;
233 		err = mtk_hw_get_value(hw, desc, reg, &ret);
234 		break;
235 	case MTK_PIN_CONFIG_PU_ADV:
236 	case MTK_PIN_CONFIG_PD_ADV:
237 		if (!hw->soc->adv_pull_get)
238 			break;
239 		pullup = param == MTK_PIN_CONFIG_PU_ADV;
240 		err = hw->soc->adv_pull_get(hw, desc, pullup, &ret);
241 		break;
242 	case MTK_PIN_CONFIG_DRV_ADV:
243 		if (!hw->soc->adv_drive_get)
244 			break;
245 		err = hw->soc->adv_drive_get(hw, desc, &ret);
246 		break;
247 	}
248 
249 	if (!err)
250 		*config = pinconf_to_config_packed(param, ret);
251 
252 	return err;
253 }
254 
255 static int mtk_pinconf_set(struct pinctrl_dev *pctldev, unsigned int pin,
256 			   enum pin_config_param param, u32 arg)
257 {
258 	struct mtk_pinctrl *hw = pinctrl_dev_get_drvdata(pctldev);
259 	const struct mtk_pin_desc *desc;
260 	int err = -ENOTSUPP;
261 	u32 reg;
262 
263 	if (pin >= hw->soc->npins)
264 		return -EINVAL;
265 
266 	desc = (const struct mtk_pin_desc *)&hw->soc->pins[pin];
267 
268 	switch ((u32)param) {
269 	case PIN_CONFIG_BIAS_DISABLE:
270 		if (!hw->soc->bias_set_combo)
271 			break;
272 		err = hw->soc->bias_set_combo(hw, desc, 0, MTK_DISABLE);
273 		break;
274 	case PIN_CONFIG_BIAS_PULL_UP:
275 		if (!hw->soc->bias_set_combo)
276 			break;
277 		err = hw->soc->bias_set_combo(hw, desc, 1, arg);
278 		break;
279 	case PIN_CONFIG_BIAS_PULL_DOWN:
280 		if (!hw->soc->bias_set_combo)
281 			break;
282 		err = hw->soc->bias_set_combo(hw, desc, 0, arg);
283 		break;
284 	case PIN_CONFIG_OUTPUT_ENABLE:
285 		err = mtk_hw_set_value(hw, desc, PINCTRL_PIN_REG_SMT,
286 				       MTK_DISABLE);
287 		/* Keep set direction to consider the case that a GPIO pin
288 		 *  does not have SMT control
289 		 */
290 		if (err != -ENOTSUPP)
291 			break;
292 
293 		err = mtk_hw_set_value(hw, desc, PINCTRL_PIN_REG_DIR,
294 				       MTK_OUTPUT);
295 		break;
296 	case PIN_CONFIG_INPUT_ENABLE:
297 		/* regard all non-zero value as enable */
298 		err = mtk_hw_set_value(hw, desc, PINCTRL_PIN_REG_IES, !!arg);
299 		if (err)
300 			break;
301 
302 		err = mtk_hw_set_value(hw, desc, PINCTRL_PIN_REG_DIR,
303 				       MTK_INPUT);
304 		break;
305 	case PIN_CONFIG_SLEW_RATE:
306 		/* regard all non-zero value as enable */
307 		err = mtk_hw_set_value(hw, desc, PINCTRL_PIN_REG_SR, !!arg);
308 		break;
309 	case PIN_CONFIG_OUTPUT:
310 		err = mtk_hw_set_value(hw, desc, PINCTRL_PIN_REG_DO,
311 				       arg);
312 		if (err)
313 			break;
314 
315 		err = mtk_hw_set_value(hw, desc, PINCTRL_PIN_REG_DIR,
316 				       MTK_OUTPUT);
317 		break;
318 	case PIN_CONFIG_INPUT_SCHMITT:
319 	case PIN_CONFIG_INPUT_SCHMITT_ENABLE:
320 		/* arg = 1: Input mode & SMT enable ;
321 		 * arg = 0: Output mode & SMT disable
322 		 */
323 		err = mtk_hw_set_value(hw, desc, PINCTRL_PIN_REG_DIR, !arg);
324 		if (err)
325 			break;
326 
327 		err = mtk_hw_set_value(hw, desc, PINCTRL_PIN_REG_SMT, !!arg);
328 		break;
329 	case PIN_CONFIG_DRIVE_STRENGTH:
330 		if (!hw->soc->drive_set)
331 			break;
332 		err = hw->soc->drive_set(hw, desc, arg);
333 		break;
334 	case PIN_CONFIG_DRIVE_STRENGTH_UA:
335 		if (!hw->soc->adv_drive_set)
336 			break;
337 
338 		err = mtk_drv_uA_to_adv(arg);
339 		if (err < 0)
340 			break;
341 		err = hw->soc->adv_drive_set(hw, desc, err);
342 		break;
343 	case MTK_PIN_CONFIG_TDSEL:
344 	case MTK_PIN_CONFIG_RDSEL:
345 		reg = (param == MTK_PIN_CONFIG_TDSEL) ?
346 		       PINCTRL_PIN_REG_TDSEL : PINCTRL_PIN_REG_RDSEL;
347 		err = mtk_hw_set_value(hw, desc, reg, arg);
348 		break;
349 	case MTK_PIN_CONFIG_PU_ADV:
350 	case MTK_PIN_CONFIG_PD_ADV:
351 		if (!hw->soc->adv_pull_set)
352 			break;
353 		err = hw->soc->adv_pull_set(hw, desc,
354 					    (param == MTK_PIN_CONFIG_PU_ADV),
355 					    arg);
356 		break;
357 	case MTK_PIN_CONFIG_DRV_ADV:
358 		if (!hw->soc->adv_drive_set)
359 			break;
360 		err = hw->soc->adv_drive_set(hw, desc, arg);
361 		break;
362 	}
363 
364 	return err;
365 }
366 
367 static struct mtk_pinctrl_group *
368 mtk_pctrl_find_group_by_pin(struct mtk_pinctrl *hw, u32 pin)
369 {
370 	int i;
371 
372 	for (i = 0; i < hw->soc->ngrps; i++) {
373 		struct mtk_pinctrl_group *grp = hw->groups + i;
374 
375 		if (grp->pin == pin)
376 			return grp;
377 	}
378 
379 	return NULL;
380 }
381 
382 static const struct mtk_func_desc *
383 mtk_pctrl_find_function_by_pin(struct mtk_pinctrl *hw, u32 pin_num, u32 fnum)
384 {
385 	const struct mtk_pin_desc *pin = hw->soc->pins + pin_num;
386 	const struct mtk_func_desc *func = pin->funcs;
387 
388 	while (func && func->name) {
389 		if (func->muxval == fnum)
390 			return func;
391 		func++;
392 	}
393 
394 	return NULL;
395 }
396 
397 static bool mtk_pctrl_is_function_valid(struct mtk_pinctrl *hw, u32 pin_num,
398 					u32 fnum)
399 {
400 	int i;
401 
402 	for (i = 0; i < hw->soc->npins; i++) {
403 		const struct mtk_pin_desc *pin = hw->soc->pins + i;
404 
405 		if (pin->number == pin_num) {
406 			const struct mtk_func_desc *func = pin->funcs;
407 
408 			while (func && func->name) {
409 				if (func->muxval == fnum)
410 					return true;
411 				func++;
412 			}
413 
414 			break;
415 		}
416 	}
417 
418 	return false;
419 }
420 
421 static int mtk_pctrl_dt_node_to_map_func(struct mtk_pinctrl *pctl,
422 					 u32 pin, u32 fnum,
423 					 struct mtk_pinctrl_group *grp,
424 					 struct pinctrl_map **map,
425 					 unsigned *reserved_maps,
426 					 unsigned *num_maps)
427 {
428 	bool ret;
429 
430 	if (*num_maps == *reserved_maps)
431 		return -ENOSPC;
432 
433 	(*map)[*num_maps].type = PIN_MAP_TYPE_MUX_GROUP;
434 	(*map)[*num_maps].data.mux.group = grp->name;
435 
436 	ret = mtk_pctrl_is_function_valid(pctl, pin, fnum);
437 	if (!ret) {
438 		dev_err(pctl->dev, "invalid function %d on pin %d .\n",
439 			fnum, pin);
440 		return -EINVAL;
441 	}
442 
443 	(*map)[*num_maps].data.mux.function = mtk_gpio_functions[fnum];
444 	(*num_maps)++;
445 
446 	return 0;
447 }
448 
449 static int mtk_pctrl_dt_subnode_to_map(struct pinctrl_dev *pctldev,
450 				       struct device_node *node,
451 				       struct pinctrl_map **map,
452 				       unsigned *reserved_maps,
453 				       unsigned *num_maps)
454 {
455 	struct mtk_pinctrl *hw = pinctrl_dev_get_drvdata(pctldev);
456 	int num_pins, num_funcs, maps_per_pin, i, err;
457 	struct mtk_pinctrl_group *grp;
458 	unsigned int num_configs;
459 	bool has_config = false;
460 	unsigned long *configs;
461 	u32 pinfunc, pin, func;
462 	struct property *pins;
463 	unsigned reserve = 0;
464 
465 	pins = of_find_property(node, "pinmux", NULL);
466 	if (!pins) {
467 		dev_err(hw->dev, "missing pins property in node %pOFn .\n",
468 			node);
469 		return -EINVAL;
470 	}
471 
472 	err = pinconf_generic_parse_dt_config(node, pctldev, &configs,
473 					      &num_configs);
474 	if (err)
475 		return err;
476 
477 	if (num_configs)
478 		has_config = true;
479 
480 	num_pins = pins->length / sizeof(u32);
481 	num_funcs = num_pins;
482 	maps_per_pin = 0;
483 	if (num_funcs)
484 		maps_per_pin++;
485 	if (has_config && num_pins >= 1)
486 		maps_per_pin++;
487 
488 	if (!num_pins || !maps_per_pin) {
489 		err = -EINVAL;
490 		goto exit;
491 	}
492 
493 	reserve = num_pins * maps_per_pin;
494 
495 	err = pinctrl_utils_reserve_map(pctldev, map, reserved_maps, num_maps,
496 					reserve);
497 	if (err < 0)
498 		goto exit;
499 
500 	for (i = 0; i < num_pins; i++) {
501 		err = of_property_read_u32_index(node, "pinmux", i, &pinfunc);
502 		if (err)
503 			goto exit;
504 
505 		pin = MTK_GET_PIN_NO(pinfunc);
506 		func = MTK_GET_PIN_FUNC(pinfunc);
507 
508 		if (pin >= hw->soc->npins ||
509 		    func >= ARRAY_SIZE(mtk_gpio_functions)) {
510 			dev_err(hw->dev, "invalid pins value.\n");
511 			err = -EINVAL;
512 			goto exit;
513 		}
514 
515 		grp = mtk_pctrl_find_group_by_pin(hw, pin);
516 		if (!grp) {
517 			dev_err(hw->dev, "unable to match pin %d to group\n",
518 				pin);
519 			err = -EINVAL;
520 			goto exit;
521 		}
522 
523 		err = mtk_pctrl_dt_node_to_map_func(hw, pin, func, grp, map,
524 						    reserved_maps, num_maps);
525 		if (err < 0)
526 			goto exit;
527 
528 		if (has_config) {
529 			err = pinctrl_utils_add_map_configs(pctldev, map,
530 							    reserved_maps,
531 							    num_maps,
532 							    grp->name,
533 							    configs,
534 							    num_configs,
535 							    PIN_MAP_TYPE_CONFIGS_GROUP);
536 			if (err < 0)
537 				goto exit;
538 		}
539 	}
540 
541 	err = 0;
542 
543 exit:
544 	kfree(configs);
545 	return err;
546 }
547 
548 static int mtk_pctrl_dt_node_to_map(struct pinctrl_dev *pctldev,
549 				    struct device_node *np_config,
550 				    struct pinctrl_map **map,
551 				    unsigned *num_maps)
552 {
553 	struct device_node *np;
554 	unsigned reserved_maps;
555 	int ret;
556 
557 	*map = NULL;
558 	*num_maps = 0;
559 	reserved_maps = 0;
560 
561 	for_each_child_of_node(np_config, np) {
562 		ret = mtk_pctrl_dt_subnode_to_map(pctldev, np, map,
563 						  &reserved_maps,
564 						  num_maps);
565 		if (ret < 0) {
566 			pinctrl_utils_free_map(pctldev, *map, *num_maps);
567 			of_node_put(np);
568 			return ret;
569 		}
570 	}
571 
572 	return 0;
573 }
574 
575 static int mtk_pctrl_get_groups_count(struct pinctrl_dev *pctldev)
576 {
577 	struct mtk_pinctrl *hw = pinctrl_dev_get_drvdata(pctldev);
578 
579 	return hw->soc->ngrps;
580 }
581 
582 static const char *mtk_pctrl_get_group_name(struct pinctrl_dev *pctldev,
583 					    unsigned group)
584 {
585 	struct mtk_pinctrl *hw = pinctrl_dev_get_drvdata(pctldev);
586 
587 	return hw->groups[group].name;
588 }
589 
590 static int mtk_pctrl_get_group_pins(struct pinctrl_dev *pctldev,
591 				    unsigned group, const unsigned **pins,
592 				    unsigned *num_pins)
593 {
594 	struct mtk_pinctrl *hw = pinctrl_dev_get_drvdata(pctldev);
595 
596 	*pins = (unsigned *)&hw->groups[group].pin;
597 	*num_pins = 1;
598 
599 	return 0;
600 }
601 
602 static int mtk_hw_get_value_wrap(struct mtk_pinctrl *hw, unsigned int gpio, int field)
603 {
604 	const struct mtk_pin_desc *desc;
605 	int value, err;
606 
607 	if (gpio >= hw->soc->npins)
608 		return -EINVAL;
609 
610 	desc = (const struct mtk_pin_desc *)&hw->soc->pins[gpio];
611 
612 	err = mtk_hw_get_value(hw, desc, field, &value);
613 	if (err)
614 		return err;
615 
616 	return value;
617 }
618 
619 #define mtk_pctrl_get_pinmux(hw, gpio)			\
620 	mtk_hw_get_value_wrap(hw, gpio, PINCTRL_PIN_REG_MODE)
621 
622 #define mtk_pctrl_get_direction(hw, gpio)		\
623 	mtk_hw_get_value_wrap(hw, gpio, PINCTRL_PIN_REG_DIR)
624 
625 #define mtk_pctrl_get_out(hw, gpio)			\
626 	mtk_hw_get_value_wrap(hw, gpio, PINCTRL_PIN_REG_DO)
627 
628 #define mtk_pctrl_get_in(hw, gpio)			\
629 	mtk_hw_get_value_wrap(hw, gpio, PINCTRL_PIN_REG_DI)
630 
631 #define mtk_pctrl_get_smt(hw, gpio)			\
632 	mtk_hw_get_value_wrap(hw, gpio, PINCTRL_PIN_REG_SMT)
633 
634 #define mtk_pctrl_get_ies(hw, gpio)			\
635 	mtk_hw_get_value_wrap(hw, gpio, PINCTRL_PIN_REG_IES)
636 
637 #define mtk_pctrl_get_driving(hw, gpio)			\
638 	mtk_hw_get_value_wrap(hw, gpio, PINCTRL_PIN_REG_DRV)
639 
640 ssize_t mtk_pctrl_show_one_pin(struct mtk_pinctrl *hw,
641 	unsigned int gpio, char *buf, unsigned int buf_len)
642 {
643 	int pinmux, pullup = 0, pullen = 0, len = 0, r1 = -1, r0 = -1, rsel = -1;
644 	const struct mtk_pin_desc *desc;
645 	u32 try_all_type = 0;
646 
647 	if (gpio >= hw->soc->npins)
648 		return -EINVAL;
649 
650 	if (mtk_is_virt_gpio(hw, gpio))
651 		return -EINVAL;
652 
653 	desc = (const struct mtk_pin_desc *)&hw->soc->pins[gpio];
654 	pinmux = mtk_pctrl_get_pinmux(hw, gpio);
655 	if (pinmux >= hw->soc->nfuncs)
656 		pinmux -= hw->soc->nfuncs;
657 
658 	mtk_pinconf_bias_get_combo(hw, desc, &pullup, &pullen);
659 
660 	if (hw->soc->pull_type)
661 		try_all_type = hw->soc->pull_type[desc->number];
662 
663 	if (hw->rsel_si_unit && (try_all_type & MTK_PULL_RSEL_TYPE)) {
664 		rsel = pullen;
665 		pullen = 1;
666 	} else {
667 		/* Case for: R1R0 */
668 		if (pullen == MTK_PUPD_SET_R1R0_00) {
669 			pullen = 0;
670 			r1 = 0;
671 			r0 = 0;
672 		} else if (pullen == MTK_PUPD_SET_R1R0_01) {
673 			pullen = 1;
674 			r1 = 0;
675 			r0 = 1;
676 		} else if (pullen == MTK_PUPD_SET_R1R0_10) {
677 			pullen = 1;
678 			r1 = 1;
679 			r0 = 0;
680 		} else if (pullen == MTK_PUPD_SET_R1R0_11) {
681 			pullen = 1;
682 			r1 = 1;
683 			r0 = 1;
684 		}
685 
686 		/* Case for: RSEL */
687 		if (pullen >= MTK_PULL_SET_RSEL_000 &&
688 		    pullen <= MTK_PULL_SET_RSEL_111) {
689 			rsel = pullen - MTK_PULL_SET_RSEL_000;
690 			pullen = 1;
691 		}
692 	}
693 	len += scnprintf(buf + len, buf_len - len,
694 			"%03d: %1d%1d%1d%1d%02d%1d%1d%1d%1d",
695 			gpio,
696 			pinmux,
697 			mtk_pctrl_get_direction(hw, gpio),
698 			mtk_pctrl_get_out(hw, gpio),
699 			mtk_pctrl_get_in(hw, gpio),
700 			mtk_pctrl_get_driving(hw, gpio),
701 			mtk_pctrl_get_smt(hw, gpio),
702 			mtk_pctrl_get_ies(hw, gpio),
703 			pullen,
704 			pullup);
705 
706 	if (r1 != -1)
707 		len += scnprintf(buf + len, buf_len - len, " (%1d %1d)", r1, r0);
708 	else if (rsel != -1)
709 		len += scnprintf(buf + len, buf_len - len, " (%1d)", rsel);
710 
711 	return len;
712 }
713 EXPORT_SYMBOL_GPL(mtk_pctrl_show_one_pin);
714 
715 #define PIN_DBG_BUF_SZ 96
716 static void mtk_pctrl_dbg_show(struct pinctrl_dev *pctldev, struct seq_file *s,
717 			  unsigned int gpio)
718 {
719 	struct mtk_pinctrl *hw = pinctrl_dev_get_drvdata(pctldev);
720 	char buf[PIN_DBG_BUF_SZ] = { 0 };
721 
722 	(void)mtk_pctrl_show_one_pin(hw, gpio, buf, PIN_DBG_BUF_SZ);
723 
724 	seq_printf(s, "%s", buf);
725 }
726 
727 static const struct pinctrl_ops mtk_pctlops = {
728 	.dt_node_to_map		= mtk_pctrl_dt_node_to_map,
729 	.dt_free_map		= pinctrl_utils_free_map,
730 	.get_groups_count	= mtk_pctrl_get_groups_count,
731 	.get_group_name		= mtk_pctrl_get_group_name,
732 	.get_group_pins		= mtk_pctrl_get_group_pins,
733 	.pin_dbg_show           = mtk_pctrl_dbg_show,
734 };
735 
736 static int mtk_pmx_get_funcs_cnt(struct pinctrl_dev *pctldev)
737 {
738 	return ARRAY_SIZE(mtk_gpio_functions);
739 }
740 
741 static const char *mtk_pmx_get_func_name(struct pinctrl_dev *pctldev,
742 					 unsigned selector)
743 {
744 	return mtk_gpio_functions[selector];
745 }
746 
747 static int mtk_pmx_get_func_groups(struct pinctrl_dev *pctldev,
748 				   unsigned function,
749 				   const char * const **groups,
750 				   unsigned * const num_groups)
751 {
752 	struct mtk_pinctrl *hw = pinctrl_dev_get_drvdata(pctldev);
753 
754 	*groups = hw->grp_names;
755 	*num_groups = hw->soc->ngrps;
756 
757 	return 0;
758 }
759 
760 static int mtk_pmx_set_mux(struct pinctrl_dev *pctldev,
761 			   unsigned function,
762 			   unsigned group)
763 {
764 	struct mtk_pinctrl *hw = pinctrl_dev_get_drvdata(pctldev);
765 	struct mtk_pinctrl_group *grp = hw->groups + group;
766 	const struct mtk_func_desc *desc_func;
767 	const struct mtk_pin_desc *desc;
768 	bool ret;
769 
770 	ret = mtk_pctrl_is_function_valid(hw, grp->pin, function);
771 	if (!ret) {
772 		dev_err(hw->dev, "invalid function %d on group %d .\n",
773 			function, group);
774 		return -EINVAL;
775 	}
776 
777 	desc_func = mtk_pctrl_find_function_by_pin(hw, grp->pin, function);
778 	if (!desc_func)
779 		return -EINVAL;
780 
781 	desc = (const struct mtk_pin_desc *)&hw->soc->pins[grp->pin];
782 	mtk_hw_set_value(hw, desc, PINCTRL_PIN_REG_MODE, desc_func->muxval);
783 
784 	return 0;
785 }
786 
787 static const struct pinmux_ops mtk_pmxops = {
788 	.get_functions_count	= mtk_pmx_get_funcs_cnt,
789 	.get_function_name	= mtk_pmx_get_func_name,
790 	.get_function_groups	= mtk_pmx_get_func_groups,
791 	.set_mux		= mtk_pmx_set_mux,
792 	.gpio_set_direction	= mtk_pinmux_gpio_set_direction,
793 	.gpio_request_enable	= mtk_pinmux_gpio_request_enable,
794 };
795 
796 static int mtk_pconf_group_get(struct pinctrl_dev *pctldev, unsigned group,
797 			       unsigned long *config)
798 {
799 	struct mtk_pinctrl *hw = pinctrl_dev_get_drvdata(pctldev);
800 	struct mtk_pinctrl_group *grp = &hw->groups[group];
801 
802 	 /* One pin per group only */
803 	return mtk_pinconf_get(pctldev, grp->pin, config);
804 }
805 
806 static int mtk_pconf_group_set(struct pinctrl_dev *pctldev, unsigned group,
807 			       unsigned long *configs, unsigned num_configs)
808 {
809 	struct mtk_pinctrl *hw = pinctrl_dev_get_drvdata(pctldev);
810 	struct mtk_pinctrl_group *grp = &hw->groups[group];
811 	bool drive_strength_uA_found = false;
812 	bool adv_drve_strength_found = false;
813 	int i, ret;
814 
815 	for (i = 0; i < num_configs; i++) {
816 		ret = mtk_pinconf_set(pctldev, grp->pin,
817 				      pinconf_to_config_param(configs[i]),
818 				      pinconf_to_config_argument(configs[i]));
819 		if (ret < 0)
820 			return ret;
821 
822 		if (pinconf_to_config_param(configs[i]) == PIN_CONFIG_DRIVE_STRENGTH_UA)
823 			drive_strength_uA_found = true;
824 		if (pinconf_to_config_param(configs[i]) == MTK_PIN_CONFIG_DRV_ADV)
825 			adv_drve_strength_found = true;
826 	}
827 
828 	/*
829 	 * Disable advanced drive strength mode if drive-strength-microamp
830 	 * is not set. However, mediatek,drive-strength-adv takes precedence
831 	 * as its value can explicitly request the mode be enabled or not.
832 	 */
833 	if (hw->soc->adv_drive_set && !drive_strength_uA_found &&
834 	    !adv_drve_strength_found)
835 		hw->soc->adv_drive_set(hw, &hw->soc->pins[grp->pin], 0);
836 
837 	return 0;
838 }
839 
840 static const struct pinconf_ops mtk_confops = {
841 	.pin_config_get = mtk_pinconf_get,
842 	.pin_config_group_get	= mtk_pconf_group_get,
843 	.pin_config_group_set	= mtk_pconf_group_set,
844 	.is_generic = true,
845 };
846 
847 static struct pinctrl_desc mtk_desc = {
848 	.name = PINCTRL_PINCTRL_DEV,
849 	.pctlops = &mtk_pctlops,
850 	.pmxops = &mtk_pmxops,
851 	.confops = &mtk_confops,
852 	.owner = THIS_MODULE,
853 };
854 
855 static int mtk_gpio_get_direction(struct gpio_chip *chip, unsigned int gpio)
856 {
857 	struct mtk_pinctrl *hw = gpiochip_get_data(chip);
858 	const struct mtk_pin_desc *desc;
859 	int value, err;
860 
861 	if (gpio >= hw->soc->npins)
862 		return -EINVAL;
863 
864 	/*
865 	 * "Virtual" GPIOs are always and only used for interrupts
866 	 * Since they are only used for interrupts, they are always inputs
867 	 */
868 	if (mtk_is_virt_gpio(hw, gpio))
869 		return 1;
870 
871 	desc = (const struct mtk_pin_desc *)&hw->soc->pins[gpio];
872 
873 	err = mtk_hw_get_value(hw, desc, PINCTRL_PIN_REG_DIR, &value);
874 	if (err)
875 		return err;
876 
877 	if (value)
878 		return GPIO_LINE_DIRECTION_OUT;
879 
880 	return GPIO_LINE_DIRECTION_IN;
881 }
882 
883 static int mtk_gpio_get(struct gpio_chip *chip, unsigned int gpio)
884 {
885 	struct mtk_pinctrl *hw = gpiochip_get_data(chip);
886 	const struct mtk_pin_desc *desc;
887 	int value, err;
888 
889 	if (gpio >= hw->soc->npins)
890 		return -EINVAL;
891 
892 	desc = (const struct mtk_pin_desc *)&hw->soc->pins[gpio];
893 
894 	err = mtk_hw_get_value(hw, desc, PINCTRL_PIN_REG_DI, &value);
895 	if (err)
896 		return err;
897 
898 	return !!value;
899 }
900 
901 static void mtk_gpio_set(struct gpio_chip *chip, unsigned int gpio, int value)
902 {
903 	struct mtk_pinctrl *hw = gpiochip_get_data(chip);
904 	const struct mtk_pin_desc *desc;
905 
906 	if (gpio >= hw->soc->npins)
907 		return;
908 
909 	desc = (const struct mtk_pin_desc *)&hw->soc->pins[gpio];
910 
911 	mtk_hw_set_value(hw, desc, PINCTRL_PIN_REG_DO, !!value);
912 }
913 
914 static int mtk_gpio_direction_input(struct gpio_chip *chip, unsigned int gpio)
915 {
916 	struct mtk_pinctrl *hw = gpiochip_get_data(chip);
917 
918 	if (gpio >= hw->soc->npins)
919 		return -EINVAL;
920 
921 	return pinctrl_gpio_direction_input(chip->base + gpio);
922 }
923 
924 static int mtk_gpio_direction_output(struct gpio_chip *chip, unsigned int gpio,
925 				     int value)
926 {
927 	struct mtk_pinctrl *hw = gpiochip_get_data(chip);
928 
929 	if (gpio >= hw->soc->npins)
930 		return -EINVAL;
931 
932 	mtk_gpio_set(chip, gpio, value);
933 
934 	return pinctrl_gpio_direction_output(chip->base + gpio);
935 }
936 
937 static int mtk_gpio_to_irq(struct gpio_chip *chip, unsigned int offset)
938 {
939 	struct mtk_pinctrl *hw = gpiochip_get_data(chip);
940 	const struct mtk_pin_desc *desc;
941 
942 	if (!hw->eint)
943 		return -ENOTSUPP;
944 
945 	desc = (const struct mtk_pin_desc *)&hw->soc->pins[offset];
946 
947 	if (desc->eint.eint_n == EINT_NA)
948 		return -ENOTSUPP;
949 
950 	return mtk_eint_find_irq(hw->eint, desc->eint.eint_n);
951 }
952 
953 static int mtk_gpio_set_config(struct gpio_chip *chip, unsigned int offset,
954 			       unsigned long config)
955 {
956 	struct mtk_pinctrl *hw = gpiochip_get_data(chip);
957 	const struct mtk_pin_desc *desc;
958 	u32 debounce;
959 
960 	desc = (const struct mtk_pin_desc *)&hw->soc->pins[offset];
961 
962 	if (!hw->eint ||
963 	    pinconf_to_config_param(config) != PIN_CONFIG_INPUT_DEBOUNCE ||
964 	    desc->eint.eint_n == EINT_NA)
965 		return -ENOTSUPP;
966 
967 	debounce = pinconf_to_config_argument(config);
968 
969 	return mtk_eint_set_debounce(hw->eint, desc->eint.eint_n, debounce);
970 }
971 
972 static int mtk_build_gpiochip(struct mtk_pinctrl *hw)
973 {
974 	struct gpio_chip *chip = &hw->chip;
975 	int ret;
976 
977 	chip->label		= PINCTRL_PINCTRL_DEV;
978 	chip->parent		= hw->dev;
979 	chip->request		= gpiochip_generic_request;
980 	chip->free		= gpiochip_generic_free;
981 	chip->get_direction	= mtk_gpio_get_direction;
982 	chip->direction_input	= mtk_gpio_direction_input;
983 	chip->direction_output	= mtk_gpio_direction_output;
984 	chip->get		= mtk_gpio_get;
985 	chip->set		= mtk_gpio_set;
986 	chip->to_irq		= mtk_gpio_to_irq;
987 	chip->set_config	= mtk_gpio_set_config;
988 	chip->base		= -1;
989 	chip->ngpio		= hw->soc->npins;
990 
991 	ret = gpiochip_add_data(chip, hw);
992 	if (ret < 0)
993 		return ret;
994 
995 	return 0;
996 }
997 
998 static int mtk_pctrl_build_state(struct platform_device *pdev)
999 {
1000 	struct mtk_pinctrl *hw = platform_get_drvdata(pdev);
1001 	int i;
1002 
1003 	/* Allocate groups */
1004 	hw->groups = devm_kmalloc_array(&pdev->dev, hw->soc->ngrps,
1005 					sizeof(*hw->groups), GFP_KERNEL);
1006 	if (!hw->groups)
1007 		return -ENOMEM;
1008 
1009 	/* We assume that one pin is one group, use pin name as group name. */
1010 	hw->grp_names = devm_kmalloc_array(&pdev->dev, hw->soc->ngrps,
1011 					   sizeof(*hw->grp_names), GFP_KERNEL);
1012 	if (!hw->grp_names)
1013 		return -ENOMEM;
1014 
1015 	for (i = 0; i < hw->soc->npins; i++) {
1016 		const struct mtk_pin_desc *pin = hw->soc->pins + i;
1017 		struct mtk_pinctrl_group *group = hw->groups + i;
1018 
1019 		group->name = pin->name;
1020 		group->pin = pin->number;
1021 
1022 		hw->grp_names[i] = pin->name;
1023 	}
1024 
1025 	return 0;
1026 }
1027 
1028 int mtk_paris_pinctrl_probe(struct platform_device *pdev)
1029 {
1030 	struct device *dev = &pdev->dev;
1031 	struct pinctrl_pin_desc *pins;
1032 	struct mtk_pinctrl *hw;
1033 	int err, i;
1034 
1035 	hw = devm_kzalloc(&pdev->dev, sizeof(*hw), GFP_KERNEL);
1036 	if (!hw)
1037 		return -ENOMEM;
1038 
1039 	platform_set_drvdata(pdev, hw);
1040 
1041 	hw->soc = device_get_match_data(dev);
1042 	if (!hw->soc)
1043 		return -ENOENT;
1044 
1045 	hw->dev = &pdev->dev;
1046 
1047 	if (!hw->soc->nbase_names)
1048 		return dev_err_probe(dev, -EINVAL,
1049 			"SoC should be assigned at least one register base\n");
1050 
1051 	hw->base = devm_kmalloc_array(&pdev->dev, hw->soc->nbase_names,
1052 				      sizeof(*hw->base), GFP_KERNEL);
1053 	if (!hw->base)
1054 		return -ENOMEM;
1055 
1056 	for (i = 0; i < hw->soc->nbase_names; i++) {
1057 		hw->base[i] = devm_platform_ioremap_resource_byname(pdev,
1058 					hw->soc->base_names[i]);
1059 		if (IS_ERR(hw->base[i]))
1060 			return PTR_ERR(hw->base[i]);
1061 	}
1062 
1063 	hw->nbase = hw->soc->nbase_names;
1064 
1065 	if (of_find_property(hw->dev->of_node,
1066 			     "mediatek,rsel-resistance-in-si-unit", NULL))
1067 		hw->rsel_si_unit = true;
1068 	else
1069 		hw->rsel_si_unit = false;
1070 
1071 	spin_lock_init(&hw->lock);
1072 
1073 	err = mtk_pctrl_build_state(pdev);
1074 	if (err)
1075 		return dev_err_probe(dev, err, "build state failed\n");
1076 
1077 	/* Copy from internal struct mtk_pin_desc to register to the core */
1078 	pins = devm_kmalloc_array(&pdev->dev, hw->soc->npins, sizeof(*pins),
1079 				  GFP_KERNEL);
1080 	if (!pins)
1081 		return -ENOMEM;
1082 
1083 	for (i = 0; i < hw->soc->npins; i++) {
1084 		pins[i].number = hw->soc->pins[i].number;
1085 		pins[i].name = hw->soc->pins[i].name;
1086 	}
1087 
1088 	/* Setup pins descriptions per SoC types */
1089 	mtk_desc.pins = (const struct pinctrl_pin_desc *)pins;
1090 	mtk_desc.npins = hw->soc->npins;
1091 	mtk_desc.num_custom_params = ARRAY_SIZE(mtk_custom_bindings);
1092 	mtk_desc.custom_params = mtk_custom_bindings;
1093 #ifdef CONFIG_DEBUG_FS
1094 	mtk_desc.custom_conf_items = mtk_conf_items;
1095 #endif
1096 
1097 	err = devm_pinctrl_register_and_init(&pdev->dev, &mtk_desc, hw,
1098 					     &hw->pctrl);
1099 	if (err)
1100 		return err;
1101 
1102 	err = pinctrl_enable(hw->pctrl);
1103 	if (err)
1104 		return err;
1105 
1106 	err = mtk_build_eint(hw, pdev);
1107 	if (err)
1108 		dev_warn(&pdev->dev,
1109 			 "Failed to add EINT, but pinctrl still can work\n");
1110 
1111 	/* Build gpiochip should be after pinctrl_enable is done */
1112 	err = mtk_build_gpiochip(hw);
1113 	if (err)
1114 		return dev_err_probe(dev, err, "Failed to add gpio_chip\n");
1115 
1116 	platform_set_drvdata(pdev, hw);
1117 
1118 	return 0;
1119 }
1120 EXPORT_SYMBOL_GPL(mtk_paris_pinctrl_probe);
1121 
1122 static int mtk_paris_pinctrl_suspend(struct device *device)
1123 {
1124 	struct mtk_pinctrl *pctl = dev_get_drvdata(device);
1125 
1126 	return mtk_eint_do_suspend(pctl->eint);
1127 }
1128 
1129 static int mtk_paris_pinctrl_resume(struct device *device)
1130 {
1131 	struct mtk_pinctrl *pctl = dev_get_drvdata(device);
1132 
1133 	return mtk_eint_do_resume(pctl->eint);
1134 }
1135 
1136 const struct dev_pm_ops mtk_paris_pinctrl_pm_ops = {
1137 	.suspend_noirq = mtk_paris_pinctrl_suspend,
1138 	.resume_noirq = mtk_paris_pinctrl_resume,
1139 };
1140 
1141 MODULE_LICENSE("GPL v2");
1142 MODULE_DESCRIPTION("MediaTek Pinctrl Common Driver V2 Paris");
1143