53 static struct regmap *mtk_get_regmap(struct mtk_pinctrl *pctl,  in mtk_get_regmap()  argument
56 	if (pin >= pctl->devdata->type1_start && pin < pctl->devdata->type1_end)  in mtk_get_regmap()
57 		return pctl->regmap2;  in mtk_get_regmap()
58 	return pctl->regmap1;  in mtk_get_regmap()
61 static unsigned int mtk_get_port(struct mtk_pinctrl *pctl, unsigned long pin)  in mtk_get_port()  argument
64 	return ((pin >> 4) & pctl->devdata->port_mask)  in mtk_get_port()
65 			<< pctl->devdata->port_shf;  in mtk_get_port()
74 	struct mtk_pinctrl *pctl = pinctrl_dev_get_drvdata(pctldev);  in mtk_pmx_gpio_set_direction()  local
76 	reg_addr = mtk_get_port(pctl, offset) + pctl->devdata->dir_offset;  in mtk_pmx_gpio_set_direction()
79 	if (pctl->devdata->spec_dir_set)  in mtk_pmx_gpio_set_direction()
80 		pctl->devdata->spec_dir_set(&reg_addr, offset);  in mtk_pmx_gpio_set_direction()
84 		reg_addr = CLR_ADDR(reg_addr, pctl);  in mtk_pmx_gpio_set_direction()
86 		reg_addr = SET_ADDR(reg_addr, pctl);  in mtk_pmx_gpio_set_direction()
88 	regmap_write(mtk_get_regmap(pctl, offset), reg_addr, bit);  in mtk_pmx_gpio_set_direction()
96 	struct mtk_pinctrl *pctl = gpiochip_get_data(chip);  in mtk_gpio_set()  local
98 	reg_addr = mtk_get_port(pctl, offset) + pctl->devdata->dout_offset;  in mtk_gpio_set()
102 		reg_addr = SET_ADDR(reg_addr, pctl);  in mtk_gpio_set()
104 		reg_addr = CLR_ADDR(reg_addr, pctl);  in mtk_gpio_set()
106 	regmap_write(mtk_get_regmap(pctl, offset), reg_addr, bit);  in mtk_gpio_set()
109 static int mtk_pconf_set_ies_smt(struct mtk_pinctrl *pctl, unsigned pin,  in mtk_pconf_set_ies_smt()  argument
119 	if (!pctl->devdata->spec_ies_smt_set &&  in mtk_pconf_set_ies_smt()
120 		pctl->devdata->ies_offset == MTK_PINCTRL_NOT_SUPPORT &&  in mtk_pconf_set_ies_smt()
124 	if (!pctl->devdata->spec_ies_smt_set &&  in mtk_pconf_set_ies_smt()
125 		pctl->devdata->smt_offset == MTK_PINCTRL_NOT_SUPPORT &&  in mtk_pconf_set_ies_smt()
133 	if (pctl->devdata->spec_ies_smt_set) {  in mtk_pconf_set_ies_smt()
134 		return pctl->devdata->spec_ies_smt_set(mtk_get_regmap(pctl, pin),  in mtk_pconf_set_ies_smt()
135 			pin, pctl->devdata->port_align, value, arg);  in mtk_pconf_set_ies_smt()
141 		offset = pctl->devdata->ies_offset;  in mtk_pconf_set_ies_smt()
143 		offset = pctl->devdata->smt_offset;  in mtk_pconf_set_ies_smt()
146 		reg_addr = SET_ADDR(mtk_get_port(pctl, pin) + offset, pctl);  in mtk_pconf_set_ies_smt()
148 		reg_addr = CLR_ADDR(mtk_get_port(pctl, pin) + offset, pctl);  in mtk_pconf_set_ies_smt()
150 	regmap_write(mtk_get_regmap(pctl, pin), reg_addr, bit);  in mtk_pconf_set_ies_smt()
181 		struct mtk_pinctrl *pctl,  unsigned long pin) {  in mtk_find_pin_drv_grp_by_pin()  argument
184 	for (i = 0; i < pctl->devdata->n_pin_drv_grps; i++) {  in mtk_find_pin_drv_grp_by_pin()
186 				pctl->devdata->pin_drv_grp + i;  in mtk_find_pin_drv_grp_by_pin()
194 static int mtk_pconf_set_driving(struct mtk_pinctrl *pctl,  in mtk_pconf_set_driving()  argument
202 	if (pin >= pctl->devdata->npins)  in mtk_pconf_set_driving()
205 	pin_drv = mtk_find_pin_drv_grp_by_pin(pctl, pin);  in mtk_pconf_set_driving()
206 	if (!pin_drv || pin_drv->grp > pctl->devdata->n_grp_cls)  in mtk_pconf_set_driving()
209 	drv_grp = pctl->devdata->grp_desc + pin_drv->grp;  in mtk_pconf_set_driving()
218 		return regmap_update_bits(mtk_get_regmap(pctl, pin),  in mtk_pconf_set_driving()
285 static int mtk_pconf_set_pull_select(struct mtk_pinctrl *pctl,  in mtk_pconf_set_pull_select()  argument
296 	if (pctl->devdata->spec_pull_set) {  in mtk_pconf_set_pull_select()
301 		ret = pctl->devdata->spec_pull_set(mtk_get_regmap(pctl, pin),  in mtk_pconf_set_pull_select()
302 			pin, pctl->devdata->port_align, isup, r1r0);  in mtk_pconf_set_pull_select()
309 		dev_err(pctl->dev, "invalid pull-up argument %d on pin %d .\n",  in mtk_pconf_set_pull_select()
316 		reg_pullen = SET_ADDR(mtk_get_port(pctl, pin) +  in mtk_pconf_set_pull_select()
317 			pctl->devdata->pullen_offset, pctl);  in mtk_pconf_set_pull_select()
319 		reg_pullen = CLR_ADDR(mtk_get_port(pctl, pin) +  in mtk_pconf_set_pull_select()
320 			pctl->devdata->pullen_offset, pctl);  in mtk_pconf_set_pull_select()
323 		reg_pullsel = SET_ADDR(mtk_get_port(pctl, pin) +  in mtk_pconf_set_pull_select()
324 			pctl->devdata->pullsel_offset, pctl);  in mtk_pconf_set_pull_select()
326 		reg_pullsel = CLR_ADDR(mtk_get_port(pctl, pin) +  in mtk_pconf_set_pull_select()
327 			pctl->devdata->pullsel_offset, pctl);  in mtk_pconf_set_pull_select()
329 	regmap_write(mtk_get_regmap(pctl, pin), reg_pullen, bit);  in mtk_pconf_set_pull_select()
330 	regmap_write(mtk_get_regmap(pctl, pin), reg_pullsel, bit);  in mtk_pconf_set_pull_select()
339 	struct mtk_pinctrl *pctl = pinctrl_dev_get_drvdata(pctldev);  in mtk_pconf_parse_conf()  local
343 		ret = mtk_pconf_set_pull_select(pctl, pin, false, false, arg);  in mtk_pconf_parse_conf()
346 		ret = mtk_pconf_set_pull_select(pctl, pin, true, true, arg);  in mtk_pconf_parse_conf()
349 		ret = mtk_pconf_set_pull_select(pctl, pin, true, false, arg);  in mtk_pconf_parse_conf()
353 		ret = mtk_pconf_set_ies_smt(pctl, pin, arg, param);  in mtk_pconf_parse_conf()
356 		mtk_gpio_set(pctl->chip, pin, arg);  in mtk_pconf_parse_conf()
361 		ret = mtk_pconf_set_ies_smt(pctl, pin, arg, param);  in mtk_pconf_parse_conf()
364 		ret = mtk_pconf_set_driving(pctl, pin, arg);  in mtk_pconf_parse_conf()
377 	struct mtk_pinctrl *pctl = pinctrl_dev_get_drvdata(pctldev);  in mtk_pconf_group_get()  local
379 	*config = pctl->groups[group].config;  in mtk_pconf_group_get()
387 	struct mtk_pinctrl *pctl = pinctrl_dev_get_drvdata(pctldev);  in mtk_pconf_group_set()  local
388 	struct mtk_pinctrl_group *g = &pctl->groups[group];  in mtk_pconf_group_set()
410 mtk_pctrl_find_group_by_pin(struct mtk_pinctrl *pctl, u32 pin)  in mtk_pctrl_find_group_by_pin()  argument
414 	for (i = 0; i < pctl->ngroups; i++) {  in mtk_pctrl_find_group_by_pin()
415 		struct mtk_pinctrl_group *grp = pctl->groups + i;  in mtk_pctrl_find_group_by_pin()
425 		struct mtk_pinctrl *pctl, u32 pin_num, u32 fnum)  in mtk_pctrl_find_function_by_pin()  argument
427 	const struct mtk_desc_pin *pin = pctl->devdata->pins + pin_num;  in mtk_pctrl_find_function_by_pin()
439 static bool mtk_pctrl_is_function_valid(struct mtk_pinctrl *pctl,  in mtk_pctrl_is_function_valid()  argument
444 	for (i = 0; i < pctl->devdata->npins; i++) {  in mtk_pctrl_is_function_valid()
445 		const struct mtk_desc_pin *pin = pctl->devdata->pins + i;  in mtk_pctrl_is_function_valid()
464 static int mtk_pctrl_dt_node_to_map_func(struct mtk_pinctrl *pctl,  in mtk_pctrl_dt_node_to_map_func()  argument
477 	ret = mtk_pctrl_is_function_valid(pctl, pin, fnum);  in mtk_pctrl_dt_node_to_map_func()
479 		dev_err(pctl->dev, "invalid function %d on pin %d .\n",  in mtk_pctrl_dt_node_to_map_func()
505 	struct mtk_pinctrl *pctl = pinctrl_dev_get_drvdata(pctldev);  in mtk_pctrl_dt_subnode_to_map()  local
509 		dev_err(pctl->dev, "missing pins property in node %pOFn .\n",  in mtk_pctrl_dt_subnode_to_map()
551 		if (pin >= pctl->devdata->npins ||  in mtk_pctrl_dt_subnode_to_map()
553 			dev_err(pctl->dev, "invalid pins value.\n");  in mtk_pctrl_dt_subnode_to_map()
558 		grp = mtk_pctrl_find_group_by_pin(pctl, pin);  in mtk_pctrl_dt_subnode_to_map()
560 			dev_err(pctl->dev, "unable to match pin %d to group\n",  in mtk_pctrl_dt_subnode_to_map()
566 		err = mtk_pctrl_dt_node_to_map_func(pctl, pin, func, grp, map,  in mtk_pctrl_dt_subnode_to_map()
615 	struct mtk_pinctrl *pctl = pinctrl_dev_get_drvdata(pctldev);  in mtk_pctrl_get_groups_count()  local
617 	return pctl->ngroups;  in mtk_pctrl_get_groups_count()
623 	struct mtk_pinctrl *pctl = pinctrl_dev_get_drvdata(pctldev);  in mtk_pctrl_get_group_name()  local
625 	return pctl->groups[group].name;  in mtk_pctrl_get_group_name()
633 	struct mtk_pinctrl *pctl = pinctrl_dev_get_drvdata(pctldev);  in mtk_pctrl_get_group_pins()  local
635 	*pins = (unsigned *)&pctl->groups[group].pin;  in mtk_pctrl_get_group_pins()
665 	struct mtk_pinctrl *pctl = pinctrl_dev_get_drvdata(pctldev);  in mtk_pmx_get_func_groups()  local
667 	*groups = pctl->grp_names;  in mtk_pmx_get_func_groups()
668 	*num_groups = pctl->ngroups;  in mtk_pmx_get_func_groups()
680 	struct mtk_pinctrl *pctl = pinctrl_dev_get_drvdata(pctldev);  in mtk_pmx_set_mode()  local
682 	if (pctl->devdata->spec_pinmux_set)  in mtk_pmx_set_mode()
683 		pctl->devdata->spec_pinmux_set(mtk_get_regmap(pctl, pin),  in mtk_pmx_set_mode()
686 	reg_addr = ((pin / MAX_GPIO_MODE_PER_REG) << pctl->devdata->port_shf)  in mtk_pmx_set_mode()
687 			+ pctl->devdata->pinmux_offset;  in mtk_pmx_set_mode()
693 	return regmap_update_bits(mtk_get_regmap(pctl, pin),  in mtk_pmx_set_mode()
698 mtk_find_pin_by_eint_num(struct mtk_pinctrl *pctl, unsigned int eint_num)  in mtk_find_pin_by_eint_num()  argument
703 	for (i = 0; i < pctl->devdata->npins; i++) {  in mtk_find_pin_by_eint_num()
704 		pin = pctl->devdata->pins + i;  in mtk_find_pin_by_eint_num()
718 	struct mtk_pinctrl *pctl = pinctrl_dev_get_drvdata(pctldev);  in mtk_pmx_set_mux()  local
719 	struct mtk_pinctrl_group *g = pctl->groups + group;  in mtk_pmx_set_mux()
721 	ret = mtk_pctrl_is_function_valid(pctl, g->pin, function);  in mtk_pmx_set_mux()
723 		dev_err(pctl->dev, "invalid function %d on group %d .\n",  in mtk_pmx_set_mux()
728 	desc = mtk_pctrl_find_function_by_pin(pctl, g->pin, function);  in mtk_pmx_set_mux()
735 static int mtk_pmx_find_gpio_mode(struct mtk_pinctrl *pctl,  in mtk_pmx_find_gpio_mode()  argument
738 	const struct mtk_desc_pin *pin = pctl->devdata->pins + offset;  in mtk_pmx_find_gpio_mode()
755 	struct mtk_pinctrl *pctl = pinctrl_dev_get_drvdata(pctldev);  in mtk_pmx_gpio_request_enable()  local
757 	muxval = mtk_pmx_find_gpio_mode(pctl, offset);  in mtk_pmx_gpio_request_enable()
760 		dev_err(pctl->dev, "invalid gpio pin %d.\n", offset);  in mtk_pmx_gpio_request_enable()
765 	mtk_pconf_set_ies_smt(pctl, offset, 1, PIN_CONFIG_INPUT_ENABLE);  in mtk_pmx_gpio_request_enable()
798 	struct mtk_pinctrl *pctl = gpiochip_get_data(chip);  in mtk_gpio_get_direction()  local
800 	reg_addr =  mtk_get_port(pctl, offset) + pctl->devdata->dir_offset;  in mtk_gpio_get_direction()
803 	if (pctl->devdata->spec_dir_set)  in mtk_gpio_get_direction()
804 		pctl->devdata->spec_dir_set(&reg_addr, offset);  in mtk_gpio_get_direction()
806 	regmap_read(pctl->regmap1, reg_addr, &read_val);  in mtk_gpio_get_direction()
818 	struct mtk_pinctrl *pctl = gpiochip_get_data(chip);  in mtk_gpio_get()  local
820 	reg_addr = mtk_get_port(pctl, offset) +  in mtk_gpio_get()
821 		pctl->devdata->din_offset;  in mtk_gpio_get()
824 	regmap_read(pctl->regmap1, reg_addr, &read_val);  in mtk_gpio_get()
830 	struct mtk_pinctrl *pctl = gpiochip_get_data(chip);  in mtk_gpio_to_irq()  local
834 	pin = pctl->devdata->pins + offset;  in mtk_gpio_to_irq()
840 	return mtk_eint_find_irq(pctl->eint, eint_n);  in mtk_gpio_to_irq()
846 	struct mtk_pinctrl *pctl = gpiochip_get_data(chip);  in mtk_gpio_set_config()  local
854 	pin = pctl->devdata->pins + offset;  in mtk_gpio_set_config()
861 	return mtk_eint_set_debounce(pctl->eint, eint_n, debounce);  in mtk_gpio_set_config()
880 	struct mtk_pinctrl *pctl = dev_get_drvdata(device);  in mtk_eint_suspend()  local
882 	return mtk_eint_do_suspend(pctl->eint);  in mtk_eint_suspend()
887 	struct mtk_pinctrl *pctl = dev_get_drvdata(device);  in mtk_eint_resume()  local
889 	return mtk_eint_do_resume(pctl->eint);  in mtk_eint_resume()
899 	struct mtk_pinctrl *pctl = platform_get_drvdata(pdev);  in mtk_pctrl_build_state()  local
902 	pctl->ngroups = pctl->devdata->npins;  in mtk_pctrl_build_state()
905 	pctl->groups = devm_kcalloc(&pdev->dev, pctl->ngroups,  in mtk_pctrl_build_state()
906 				    sizeof(*pctl->groups), GFP_KERNEL);  in mtk_pctrl_build_state()
907 	if (!pctl->groups)  in mtk_pctrl_build_state()
911 	pctl->grp_names = devm_kcalloc(&pdev->dev, pctl->ngroups,  in mtk_pctrl_build_state()
912 				       sizeof(*pctl->grp_names), GFP_KERNEL);  in mtk_pctrl_build_state()
913 	if (!pctl->grp_names)  in mtk_pctrl_build_state()
916 	for (i = 0; i < pctl->devdata->npins; i++) {  in mtk_pctrl_build_state()
917 		const struct mtk_desc_pin *pin = pctl->devdata->pins + i;  in mtk_pctrl_build_state()
918 		struct mtk_pinctrl_group *group = pctl->groups + i;  in mtk_pctrl_build_state()
923 		pctl->grp_names[i] = pin->pin.name;  in mtk_pctrl_build_state()
933 	struct mtk_pinctrl *pctl = (struct mtk_pinctrl *)data;  in mtk_xt_get_gpio_n()  local
936 	pin = mtk_find_pin_by_eint_num(pctl, eint_n);  in mtk_xt_get_gpio_n()
940 	*gpio_chip = pctl->chip;  in mtk_xt_get_gpio_n()
948 	struct mtk_pinctrl *pctl = (struct mtk_pinctrl *)data;  in mtk_xt_get_gpio_state()  local
951 	pin = mtk_find_pin_by_eint_num(pctl, eint_n);  in mtk_xt_get_gpio_state()
955 	return mtk_gpio_get(pctl->chip, pin->pin.number);  in mtk_xt_get_gpio_state()
960 	struct mtk_pinctrl *pctl = (struct mtk_pinctrl *)data;  in mtk_xt_set_gpio_as_eint()  local
963 	pin = mtk_find_pin_by_eint_num(pctl, eint_n);  in mtk_xt_set_gpio_as_eint()
968 	mtk_pmx_set_mode(pctl->pctl_dev, pin->pin.number, pin->eint.eintmux);  in mtk_xt_set_gpio_as_eint()
970 	mtk_pmx_gpio_set_direction(pctl->pctl_dev, NULL, pin->pin.number,  in mtk_xt_set_gpio_as_eint()
973 	mtk_pconf_set_ies_smt(pctl, pin->pin.number, 1,  in mtk_xt_set_gpio_as_eint()
985 static int mtk_eint_init(struct mtk_pinctrl *pctl, struct platform_device *pdev)  in mtk_eint_init()  argument
992 	pctl->eint = devm_kzalloc(pctl->dev, sizeof(*pctl->eint), GFP_KERNEL);  in mtk_eint_init()
993 	if (!pctl->eint)  in mtk_eint_init()
996 	pctl->eint->base = devm_platform_ioremap_resource(pdev, 0);  in mtk_eint_init()
997 	if (IS_ERR(pctl->eint->base))  in mtk_eint_init()
998 		return PTR_ERR(pctl->eint->base);  in mtk_eint_init()
1000 	pctl->eint->irq = irq_of_parse_and_map(np, 0);  in mtk_eint_init()
1001 	if (!pctl->eint->irq)  in mtk_eint_init()
1004 	pctl->eint->dev = &pdev->dev;  in mtk_eint_init()
1009 	pctl->eint->regs = pctl->devdata->eint_regs;  in mtk_eint_init()
1010 	pctl->eint->hw = &pctl->devdata->eint_hw;  in mtk_eint_init()
1011 	pctl->eint->pctl = pctl;  in mtk_eint_init()
1012 	pctl->eint->gpio_xlate = &mtk_eint_xt;  in mtk_eint_init()
1014 	return mtk_eint_do_init(pctl->eint);  in mtk_eint_init()
1022 	struct mtk_pinctrl *pctl;  in mtk_pctrl_init()  local
1027 	pctl = devm_kzalloc(&pdev->dev, sizeof(*pctl), GFP_KERNEL);  in mtk_pctrl_init()
1028 	if (!pctl)  in mtk_pctrl_init()
1031 	platform_set_drvdata(pdev, pctl);  in mtk_pctrl_init()
1041 		pctl->regmap1 = syscon_node_to_regmap(node);  in mtk_pctrl_init()
1042 		if (IS_ERR(pctl->regmap1))  in mtk_pctrl_init()
1043 			return PTR_ERR(pctl->regmap1);  in mtk_pctrl_init()
1045 		pctl->regmap1  = regmap;  in mtk_pctrl_init()
1054 		pctl->regmap2 = syscon_node_to_regmap(node);  in mtk_pctrl_init()
1055 		if (IS_ERR(pctl->regmap2))  in mtk_pctrl_init()
1056 			return PTR_ERR(pctl->regmap2);  in mtk_pctrl_init()
1059 	pctl->devdata = data;  in mtk_pctrl_init()
1066 	pins = devm_kcalloc(&pdev->dev, pctl->devdata->npins, sizeof(*pins),  in mtk_pctrl_init()
1071 	for (i = 0; i < pctl->devdata->npins; i++)  in mtk_pctrl_init()
1072 		pins[i] = pctl->devdata->pins[i].pin;  in mtk_pctrl_init()
1074 	pctl->pctl_desc.name = dev_name(&pdev->dev);  in mtk_pctrl_init()
1075 	pctl->pctl_desc.owner = THIS_MODULE;  in mtk_pctrl_init()
1076 	pctl->pctl_desc.pins = pins;  in mtk_pctrl_init()
1077 	pctl->pctl_desc.npins = pctl->devdata->npins;  in mtk_pctrl_init()
1078 	pctl->pctl_desc.confops = &mtk_pconf_ops;  in mtk_pctrl_init()
1079 	pctl->pctl_desc.pctlops = &mtk_pctrl_ops;  in mtk_pctrl_init()
1080 	pctl->pctl_desc.pmxops = &mtk_pmx_ops;  in mtk_pctrl_init()
1081 	pctl->dev = &pdev->dev;  in mtk_pctrl_init()
1083 	pctl->pctl_dev = devm_pinctrl_register(&pdev->dev, &pctl->pctl_desc,  in mtk_pctrl_init()
1084 					       pctl);  in mtk_pctrl_init()
1085 	if (IS_ERR(pctl->pctl_dev)) {  in mtk_pctrl_init()
1087 		return PTR_ERR(pctl->pctl_dev);  in mtk_pctrl_init()
1090 	pctl->chip = devm_kzalloc(&pdev->dev, sizeof(*pctl->chip), GFP_KERNEL);  in mtk_pctrl_init()
1091 	if (!pctl->chip)  in mtk_pctrl_init()
1094 	*pctl->chip = mtk_gpio_chip;  in mtk_pctrl_init()
1095 	pctl->chip->ngpio = pctl->devdata->npins;  in mtk_pctrl_init()
1096 	pctl->chip->label = dev_name(&pdev->dev);  in mtk_pctrl_init()
1097 	pctl->chip->parent = &pdev->dev;  in mtk_pctrl_init()
1098 	pctl->chip->base = -1;  in mtk_pctrl_init()
1100 	ret = gpiochip_add_data(pctl->chip, pctl);  in mtk_pctrl_init()
1105 	ret = gpiochip_add_pin_range(pctl->chip, dev_name(&pdev->dev),  in mtk_pctrl_init()
1106 			0, 0, pctl->devdata->npins);  in mtk_pctrl_init()
1112 	ret = mtk_eint_init(pctl, pdev);  in mtk_pctrl_init()
1119 	gpiochip_remove(pctl->chip);  in mtk_pctrl_init()