61 static struct regmap *mtk_get_regmap(struct mtk_pinctrl *pctl,  in mtk_get_regmap()  argument
64 	if (pin >= pctl->devdata->type1_start && pin < pctl->devdata->type1_end)  in mtk_get_regmap()
65 		return pctl->regmap2;  in mtk_get_regmap()
66 	return pctl->regmap1;  in mtk_get_regmap()
69 static unsigned int mtk_get_port(struct mtk_pinctrl *pctl, unsigned long pin)  in mtk_get_port()  argument
72 	return ((pin >> 4) & pctl->devdata->port_mask)  in mtk_get_port()
73 			<< pctl->devdata->port_shf;  in mtk_get_port()
82 	struct mtk_pinctrl *pctl = pinctrl_dev_get_drvdata(pctldev);  in mtk_pmx_gpio_set_direction()  local
84 	reg_addr = mtk_get_port(pctl, offset) + pctl->devdata->dir_offset;  in mtk_pmx_gpio_set_direction()
87 	if (pctl->devdata->spec_dir_set)  in mtk_pmx_gpio_set_direction()
88 		pctl->devdata->spec_dir_set(&reg_addr, offset);  in mtk_pmx_gpio_set_direction()
92 		reg_addr = CLR_ADDR(reg_addr, pctl);  in mtk_pmx_gpio_set_direction()
94 		reg_addr = SET_ADDR(reg_addr, pctl);  in mtk_pmx_gpio_set_direction()
96 	regmap_write(mtk_get_regmap(pctl, offset), reg_addr, bit);  in mtk_pmx_gpio_set_direction()
104 	struct mtk_pinctrl *pctl = gpiochip_get_data(chip);  in mtk_gpio_set()  local
106 	reg_addr = mtk_get_port(pctl, offset) + pctl->devdata->dout_offset;  in mtk_gpio_set()
110 		reg_addr = SET_ADDR(reg_addr, pctl);  in mtk_gpio_set()
112 		reg_addr = CLR_ADDR(reg_addr, pctl);  in mtk_gpio_set()
114 	regmap_write(mtk_get_regmap(pctl, offset), reg_addr, bit);  in mtk_gpio_set()
117 static int mtk_pconf_set_ies_smt(struct mtk_pinctrl *pctl, unsigned pin,  in mtk_pconf_set_ies_smt()  argument
127 	if (!pctl->devdata->spec_ies_smt_set &&  in mtk_pconf_set_ies_smt()
128 		pctl->devdata->ies_offset == MTK_PINCTRL_NOT_SUPPORT &&  in mtk_pconf_set_ies_smt()
132 	if (!pctl->devdata->spec_ies_smt_set &&  in mtk_pconf_set_ies_smt()
133 		pctl->devdata->smt_offset == MTK_PINCTRL_NOT_SUPPORT &&  in mtk_pconf_set_ies_smt()
141 	if (pctl->devdata->spec_ies_smt_set) {  in mtk_pconf_set_ies_smt()
142 		return pctl->devdata->spec_ies_smt_set(mtk_get_regmap(pctl, pin),  in mtk_pconf_set_ies_smt()
143 			pin, pctl->devdata->port_align, value, arg);  in mtk_pconf_set_ies_smt()
149 		offset = pctl->devdata->ies_offset;  in mtk_pconf_set_ies_smt()
151 		offset = pctl->devdata->smt_offset;  in mtk_pconf_set_ies_smt()
154 		reg_addr = SET_ADDR(mtk_get_port(pctl, pin) + offset, pctl);  in mtk_pconf_set_ies_smt()
156 		reg_addr = CLR_ADDR(mtk_get_port(pctl, pin) + offset, pctl);  in mtk_pconf_set_ies_smt()
158 	regmap_write(mtk_get_regmap(pctl, pin), reg_addr, bit);  in mtk_pconf_set_ies_smt()
189 		struct mtk_pinctrl *pctl,  unsigned long pin) {  in mtk_find_pin_drv_grp_by_pin()  argument
192 	for (i = 0; i < pctl->devdata->n_pin_drv_grps; i++) {  in mtk_find_pin_drv_grp_by_pin()
194 				pctl->devdata->pin_drv_grp + i;  in mtk_find_pin_drv_grp_by_pin()
202 static int mtk_pconf_set_driving(struct mtk_pinctrl *pctl,  in mtk_pconf_set_driving()  argument
210 	if (pin >= pctl->devdata->npins)  in mtk_pconf_set_driving()
213 	pin_drv = mtk_find_pin_drv_grp_by_pin(pctl, pin);  in mtk_pconf_set_driving()
214 	if (!pin_drv || pin_drv->grp > pctl->devdata->n_grp_cls)  in mtk_pconf_set_driving()
217 	drv_grp = pctl->devdata->grp_desc + pin_drv->grp;  in mtk_pconf_set_driving()
226 		return regmap_update_bits(mtk_get_regmap(pctl, pin),  in mtk_pconf_set_driving()
293 static int mtk_pconf_set_pull_select(struct mtk_pinctrl *pctl,  in mtk_pconf_set_pull_select()  argument
304 	if (pctl->devdata->spec_pull_set) {  in mtk_pconf_set_pull_select()
309 		ret = pctl->devdata->spec_pull_set(mtk_get_regmap(pctl, pin),  in mtk_pconf_set_pull_select()
310 			pin, pctl->devdata->port_align, isup, r1r0);  in mtk_pconf_set_pull_select()
317 		dev_err(pctl->dev, "invalid pull-up argument %d on pin %d .\n",  in mtk_pconf_set_pull_select()
324 		reg_pullen = SET_ADDR(mtk_get_port(pctl, pin) +  in mtk_pconf_set_pull_select()
325 			pctl->devdata->pullen_offset, pctl);  in mtk_pconf_set_pull_select()
327 		reg_pullen = CLR_ADDR(mtk_get_port(pctl, pin) +  in mtk_pconf_set_pull_select()
328 			pctl->devdata->pullen_offset, pctl);  in mtk_pconf_set_pull_select()
331 		reg_pullsel = SET_ADDR(mtk_get_port(pctl, pin) +  in mtk_pconf_set_pull_select()
332 			pctl->devdata->pullsel_offset, pctl);  in mtk_pconf_set_pull_select()
334 		reg_pullsel = CLR_ADDR(mtk_get_port(pctl, pin) +  in mtk_pconf_set_pull_select()
335 			pctl->devdata->pullsel_offset, pctl);  in mtk_pconf_set_pull_select()
337 	regmap_write(mtk_get_regmap(pctl, pin), reg_pullen, bit);  in mtk_pconf_set_pull_select()
338 	regmap_write(mtk_get_regmap(pctl, pin), reg_pullsel, bit);  in mtk_pconf_set_pull_select()
347 	struct mtk_pinctrl *pctl = pinctrl_dev_get_drvdata(pctldev);  in mtk_pconf_parse_conf()  local
351 		ret = mtk_pconf_set_pull_select(pctl, pin, false, false, arg);  in mtk_pconf_parse_conf()
354 		ret = mtk_pconf_set_pull_select(pctl, pin, true, true, arg);  in mtk_pconf_parse_conf()
357 		ret = mtk_pconf_set_pull_select(pctl, pin, true, false, arg);  in mtk_pconf_parse_conf()
361 		ret = mtk_pconf_set_ies_smt(pctl, pin, arg, param);  in mtk_pconf_parse_conf()
364 		mtk_gpio_set(pctl->chip, pin, arg);  in mtk_pconf_parse_conf()
369 		ret = mtk_pconf_set_ies_smt(pctl, pin, arg, param);  in mtk_pconf_parse_conf()
372 		ret = mtk_pconf_set_driving(pctl, pin, arg);  in mtk_pconf_parse_conf()
385 	struct mtk_pinctrl *pctl = pinctrl_dev_get_drvdata(pctldev);  in mtk_pconf_group_get()  local
387 	*config = pctl->groups[group].config;  in mtk_pconf_group_get()
395 	struct mtk_pinctrl *pctl = pinctrl_dev_get_drvdata(pctldev);  in mtk_pconf_group_set()  local
396 	struct mtk_pinctrl_group *g = &pctl->groups[group];  in mtk_pconf_group_set()
418 mtk_pctrl_find_group_by_pin(struct mtk_pinctrl *pctl, u32 pin)  in mtk_pctrl_find_group_by_pin()  argument
422 	for (i = 0; i < pctl->ngroups; i++) {  in mtk_pctrl_find_group_by_pin()
423 		struct mtk_pinctrl_group *grp = pctl->groups + i;  in mtk_pctrl_find_group_by_pin()
433 		struct mtk_pinctrl *pctl, u32 pin_num, u32 fnum)  in mtk_pctrl_find_function_by_pin()  argument
435 	const struct mtk_desc_pin *pin = pctl->devdata->pins + pin_num;  in mtk_pctrl_find_function_by_pin()
447 static bool mtk_pctrl_is_function_valid(struct mtk_pinctrl *pctl,  in mtk_pctrl_is_function_valid()  argument
452 	for (i = 0; i < pctl->devdata->npins; i++) {  in mtk_pctrl_is_function_valid()
453 		const struct mtk_desc_pin *pin = pctl->devdata->pins + i;  in mtk_pctrl_is_function_valid()
472 static int mtk_pctrl_dt_node_to_map_func(struct mtk_pinctrl *pctl,  in mtk_pctrl_dt_node_to_map_func()  argument
485 	ret = mtk_pctrl_is_function_valid(pctl, pin, fnum);  in mtk_pctrl_dt_node_to_map_func()
487 		dev_err(pctl->dev, "invalid function %d on pin %d .\n",  in mtk_pctrl_dt_node_to_map_func()
513 	struct mtk_pinctrl *pctl = pinctrl_dev_get_drvdata(pctldev);  in mtk_pctrl_dt_subnode_to_map()  local
517 		dev_err(pctl->dev, "missing pins property in node %s .\n",  in mtk_pctrl_dt_subnode_to_map()
559 		if (pin >= pctl->devdata->npins ||  in mtk_pctrl_dt_subnode_to_map()
561 			dev_err(pctl->dev, "invalid pins value.\n");  in mtk_pctrl_dt_subnode_to_map()
566 		grp = mtk_pctrl_find_group_by_pin(pctl, pin);  in mtk_pctrl_dt_subnode_to_map()
568 			dev_err(pctl->dev, "unable to match pin %d to group\n",  in mtk_pctrl_dt_subnode_to_map()
574 		err = mtk_pctrl_dt_node_to_map_func(pctl, pin, func, grp, map,  in mtk_pctrl_dt_subnode_to_map()
623 	struct mtk_pinctrl *pctl = pinctrl_dev_get_drvdata(pctldev);  in mtk_pctrl_get_groups_count()  local
625 	return pctl->ngroups;  in mtk_pctrl_get_groups_count()
631 	struct mtk_pinctrl *pctl = pinctrl_dev_get_drvdata(pctldev);  in mtk_pctrl_get_group_name()  local
633 	return pctl->groups[group].name;  in mtk_pctrl_get_group_name()
641 	struct mtk_pinctrl *pctl = pinctrl_dev_get_drvdata(pctldev);  in mtk_pctrl_get_group_pins()  local
643 	*pins = (unsigned *)&pctl->groups[group].pin;  in mtk_pctrl_get_group_pins()
673 	struct mtk_pinctrl *pctl = pinctrl_dev_get_drvdata(pctldev);  in mtk_pmx_get_func_groups()  local
675 	*groups = pctl->grp_names;  in mtk_pmx_get_func_groups()
676 	*num_groups = pctl->ngroups;  in mtk_pmx_get_func_groups()
688 	struct mtk_pinctrl *pctl = pinctrl_dev_get_drvdata(pctldev);  in mtk_pmx_set_mode()  local
690 	if (pctl->devdata->spec_pinmux_set)  in mtk_pmx_set_mode()
691 		pctl->devdata->spec_pinmux_set(mtk_get_regmap(pctl, pin),  in mtk_pmx_set_mode()
694 	reg_addr = ((pin / MAX_GPIO_MODE_PER_REG) << pctl->devdata->port_shf)  in mtk_pmx_set_mode()
695 			+ pctl->devdata->pinmux_offset;  in mtk_pmx_set_mode()
701 	return regmap_update_bits(mtk_get_regmap(pctl, pin),  in mtk_pmx_set_mode()
706 mtk_find_pin_by_eint_num(struct mtk_pinctrl *pctl, unsigned int eint_num)  in mtk_find_pin_by_eint_num()  argument
711 	for (i = 0; i < pctl->devdata->npins; i++) {  in mtk_find_pin_by_eint_num()
712 		pin = pctl->devdata->pins + i;  in mtk_find_pin_by_eint_num()
726 	struct mtk_pinctrl *pctl = pinctrl_dev_get_drvdata(pctldev);  in mtk_pmx_set_mux()  local
727 	struct mtk_pinctrl_group *g = pctl->groups + group;  in mtk_pmx_set_mux()
729 	ret = mtk_pctrl_is_function_valid(pctl, g->pin, function);  in mtk_pmx_set_mux()
731 		dev_err(pctl->dev, "invalid function %d on group %d .\n",  in mtk_pmx_set_mux()
736 	desc = mtk_pctrl_find_function_by_pin(pctl, g->pin, function);  in mtk_pmx_set_mux()
743 static int mtk_pmx_find_gpio_mode(struct mtk_pinctrl *pctl,  in mtk_pmx_find_gpio_mode()  argument
746 	const struct mtk_desc_pin *pin = pctl->devdata->pins + offset;  in mtk_pmx_find_gpio_mode()
763 	struct mtk_pinctrl *pctl = pinctrl_dev_get_drvdata(pctldev);  in mtk_pmx_gpio_request_enable()  local
765 	muxval = mtk_pmx_find_gpio_mode(pctl, offset);  in mtk_pmx_gpio_request_enable()
768 		dev_err(pctl->dev, "invalid gpio pin %d.\n", offset);  in mtk_pmx_gpio_request_enable()
773 	mtk_pconf_set_ies_smt(pctl, offset, 1, PIN_CONFIG_INPUT_ENABLE);  in mtk_pmx_gpio_request_enable()
806 	struct mtk_pinctrl *pctl = gpiochip_get_data(chip);  in mtk_gpio_get_direction()  local
808 	reg_addr =  mtk_get_port(pctl, offset) + pctl->devdata->dir_offset;  in mtk_gpio_get_direction()
811 	if (pctl->devdata->spec_dir_set)  in mtk_gpio_get_direction()
812 		pctl->devdata->spec_dir_set(&reg_addr, offset);  in mtk_gpio_get_direction()
814 	regmap_read(pctl->regmap1, reg_addr, &read_val);  in mtk_gpio_get_direction()
823 	struct mtk_pinctrl *pctl = gpiochip_get_data(chip);  in mtk_gpio_get()  local
825 	reg_addr = mtk_get_port(pctl, offset) +  in mtk_gpio_get()
826 		pctl->devdata->din_offset;  in mtk_gpio_get()
829 	regmap_read(pctl->regmap1, reg_addr, &read_val);  in mtk_gpio_get()
835 	struct mtk_pinctrl *pctl = gpiochip_get_data(chip);  in mtk_gpio_to_irq()  local
839 	pin = pctl->devdata->pins + offset;  in mtk_gpio_to_irq()
845 	return mtk_eint_find_irq(pctl->eint, eint_n);  in mtk_gpio_to_irq()
851 	struct mtk_pinctrl *pctl = gpiochip_get_data(chip);  in mtk_gpio_set_config()  local
859 	pin = pctl->devdata->pins + offset;  in mtk_gpio_set_config()
866 	return mtk_eint_set_debounce(pctl->eint, eint_n, debounce);  in mtk_gpio_set_config()
885 	struct mtk_pinctrl *pctl = dev_get_drvdata(device);  in mtk_eint_suspend()  local
887 	return mtk_eint_do_suspend(pctl->eint);  in mtk_eint_suspend()
892 	struct mtk_pinctrl *pctl = dev_get_drvdata(device);  in mtk_eint_resume()  local
894 	return mtk_eint_do_resume(pctl->eint);  in mtk_eint_resume()
904 	struct mtk_pinctrl *pctl = platform_get_drvdata(pdev);  in mtk_pctrl_build_state()  local
907 	pctl->ngroups = pctl->devdata->npins;  in mtk_pctrl_build_state()
910 	pctl->groups = devm_kcalloc(&pdev->dev, pctl->ngroups,  in mtk_pctrl_build_state()
911 				    sizeof(*pctl->groups), GFP_KERNEL);  in mtk_pctrl_build_state()
912 	if (!pctl->groups)  in mtk_pctrl_build_state()
916 	pctl->grp_names = devm_kcalloc(&pdev->dev, pctl->ngroups,  in mtk_pctrl_build_state()
917 				       sizeof(*pctl->grp_names), GFP_KERNEL);  in mtk_pctrl_build_state()
918 	if (!pctl->grp_names)  in mtk_pctrl_build_state()
921 	for (i = 0; i < pctl->devdata->npins; i++) {  in mtk_pctrl_build_state()
922 		const struct mtk_desc_pin *pin = pctl->devdata->pins + i;  in mtk_pctrl_build_state()
923 		struct mtk_pinctrl_group *group = pctl->groups + i;  in mtk_pctrl_build_state()
928 		pctl->grp_names[i] = pin->pin.name;  in mtk_pctrl_build_state()
938 	struct mtk_pinctrl *pctl = (struct mtk_pinctrl *)data;  in mtk_xt_get_gpio_n()  local
941 	pin = mtk_find_pin_by_eint_num(pctl, eint_n);  in mtk_xt_get_gpio_n()
945 	*gpio_chip = pctl->chip;  in mtk_xt_get_gpio_n()
953 	struct mtk_pinctrl *pctl = (struct mtk_pinctrl *)data;  in mtk_xt_get_gpio_state()  local
956 	pin = mtk_find_pin_by_eint_num(pctl, eint_n);  in mtk_xt_get_gpio_state()
960 	return mtk_gpio_get(pctl->chip, pin->pin.number);  in mtk_xt_get_gpio_state()
965 	struct mtk_pinctrl *pctl = (struct mtk_pinctrl *)data;  in mtk_xt_set_gpio_as_eint()  local
968 	pin = mtk_find_pin_by_eint_num(pctl, eint_n);  in mtk_xt_set_gpio_as_eint()
973 	mtk_pmx_set_mode(pctl->pctl_dev, pin->pin.number, pin->eint.eintmux);  in mtk_xt_set_gpio_as_eint()
975 	mtk_pmx_gpio_set_direction(pctl->pctl_dev, NULL, pin->pin.number,  in mtk_xt_set_gpio_as_eint()
978 	mtk_pconf_set_ies_smt(pctl, pin->pin.number, 1,  in mtk_xt_set_gpio_as_eint()
990 static int mtk_eint_init(struct mtk_pinctrl *pctl, struct platform_device *pdev)  in mtk_eint_init()  argument
998 	pctl->eint = devm_kzalloc(pctl->dev, sizeof(*pctl->eint), GFP_KERNEL);  in mtk_eint_init()
999 	if (!pctl->eint)  in mtk_eint_init()
1003 	pctl->eint->base = devm_ioremap_resource(&pdev->dev, res);  in mtk_eint_init()
1004 	if (IS_ERR(pctl->eint->base))  in mtk_eint_init()
1005 		return PTR_ERR(pctl->eint->base);  in mtk_eint_init()
1007 	pctl->eint->irq = irq_of_parse_and_map(np, 0);  in mtk_eint_init()
1008 	if (!pctl->eint->irq)  in mtk_eint_init()
1011 	pctl->eint->dev = &pdev->dev;  in mtk_eint_init()
1016 	pctl->eint->regs = pctl->devdata->eint_regs;  in mtk_eint_init()
1017 	pctl->eint->hw = &pctl->devdata->eint_hw;  in mtk_eint_init()
1018 	pctl->eint->pctl = pctl;  in mtk_eint_init()
1019 	pctl->eint->gpio_xlate = &mtk_eint_xt;  in mtk_eint_init()
1021 	return mtk_eint_do_init(pctl->eint);  in mtk_eint_init()
1029 	struct mtk_pinctrl *pctl;  in mtk_pctrl_init()  local
1034 	pctl = devm_kzalloc(&pdev->dev, sizeof(*pctl), GFP_KERNEL);  in mtk_pctrl_init()
1035 	if (!pctl)  in mtk_pctrl_init()
1038 	platform_set_drvdata(pdev, pctl);  in mtk_pctrl_init()
1048 		pctl->regmap1 = syscon_node_to_regmap(node);  in mtk_pctrl_init()
1049 		if (IS_ERR(pctl->regmap1))  in mtk_pctrl_init()
1050 			return PTR_ERR(pctl->regmap1);  in mtk_pctrl_init()
1052 		pctl->regmap1  = regmap;  in mtk_pctrl_init()
1061 		pctl->regmap2 = syscon_node_to_regmap(node);  in mtk_pctrl_init()
1062 		if (IS_ERR(pctl->regmap2))  in mtk_pctrl_init()
1063 			return PTR_ERR(pctl->regmap2);  in mtk_pctrl_init()
1066 	pctl->devdata = data;  in mtk_pctrl_init()
1073 	pins = devm_kcalloc(&pdev->dev, pctl->devdata->npins, sizeof(*pins),  in mtk_pctrl_init()
1078 	for (i = 0; i < pctl->devdata->npins; i++)  in mtk_pctrl_init()
1079 		pins[i] = pctl->devdata->pins[i].pin;  in mtk_pctrl_init()
1081 	pctl->pctl_desc.name = dev_name(&pdev->dev);  in mtk_pctrl_init()
1082 	pctl->pctl_desc.owner = THIS_MODULE;  in mtk_pctrl_init()
1083 	pctl->pctl_desc.pins = pins;  in mtk_pctrl_init()
1084 	pctl->pctl_desc.npins = pctl->devdata->npins;  in mtk_pctrl_init()
1085 	pctl->pctl_desc.confops = &mtk_pconf_ops;  in mtk_pctrl_init()
1086 	pctl->pctl_desc.pctlops = &mtk_pctrl_ops;  in mtk_pctrl_init()
1087 	pctl->pctl_desc.pmxops = &mtk_pmx_ops;  in mtk_pctrl_init()
1088 	pctl->dev = &pdev->dev;  in mtk_pctrl_init()
1090 	pctl->pctl_dev = devm_pinctrl_register(&pdev->dev, &pctl->pctl_desc,  in mtk_pctrl_init()
1091 					       pctl);  in mtk_pctrl_init()
1092 	if (IS_ERR(pctl->pctl_dev)) {  in mtk_pctrl_init()
1094 		return PTR_ERR(pctl->pctl_dev);  in mtk_pctrl_init()
1097 	pctl->chip = devm_kzalloc(&pdev->dev, sizeof(*pctl->chip), GFP_KERNEL);  in mtk_pctrl_init()
1098 	if (!pctl->chip)  in mtk_pctrl_init()
1101 	*pctl->chip = mtk_gpio_chip;  in mtk_pctrl_init()
1102 	pctl->chip->ngpio = pctl->devdata->npins;  in mtk_pctrl_init()
1103 	pctl->chip->label = dev_name(&pdev->dev);  in mtk_pctrl_init()
1104 	pctl->chip->parent = &pdev->dev;  in mtk_pctrl_init()
1105 	pctl->chip->base = -1;  in mtk_pctrl_init()
1107 	ret = gpiochip_add_data(pctl->chip, pctl);  in mtk_pctrl_init()
1112 	ret = gpiochip_add_pin_range(pctl->chip, dev_name(&pdev->dev),  in mtk_pctrl_init()
1113 			0, 0, pctl->devdata->npins);  in mtk_pctrl_init()
1119 	ret = mtk_eint_init(pctl, pdev);  in mtk_pctrl_init()
1126 	gpiochip_remove(pctl->chip);  in mtk_pctrl_init()