52 static struct regmap *mtk_get_regmap(struct mtk_pinctrl *pctl,  in mtk_get_regmap()  argument
55 	if (pin >= pctl->devdata->type1_start && pin < pctl->devdata->type1_end)  in mtk_get_regmap()
56 		return pctl->regmap2;  in mtk_get_regmap()
57 	return pctl->regmap1;  in mtk_get_regmap()
60 static unsigned int mtk_get_port(struct mtk_pinctrl *pctl, unsigned long pin)  in mtk_get_port()  argument
63 	return ((pin >> pctl->devdata->mode_shf) & pctl->devdata->port_mask)  in mtk_get_port()
64 			<< pctl->devdata->port_shf;  in mtk_get_port()
73 	struct mtk_pinctrl *pctl = pinctrl_dev_get_drvdata(pctldev);  in mtk_pmx_gpio_set_direction()  local
75 	reg_addr = mtk_get_port(pctl, offset) + pctl->devdata->dir_offset;  in mtk_pmx_gpio_set_direction()
76 	bit = BIT(offset & pctl->devdata->mode_mask);  in mtk_pmx_gpio_set_direction()
78 	if (pctl->devdata->spec_dir_set)  in mtk_pmx_gpio_set_direction()
79 		pctl->devdata->spec_dir_set(&reg_addr, offset);  in mtk_pmx_gpio_set_direction()
83 		reg_addr = CLR_ADDR(reg_addr, pctl);  in mtk_pmx_gpio_set_direction()
85 		reg_addr = SET_ADDR(reg_addr, pctl);  in mtk_pmx_gpio_set_direction()
87 	regmap_write(mtk_get_regmap(pctl, offset), reg_addr, bit);  in mtk_pmx_gpio_set_direction()
95 	struct mtk_pinctrl *pctl = gpiochip_get_data(chip);  in mtk_gpio_set()  local
97 	reg_addr = mtk_get_port(pctl, offset) + pctl->devdata->dout_offset;  in mtk_gpio_set()
98 	bit = BIT(offset & pctl->devdata->mode_mask);  in mtk_gpio_set()
101 		reg_addr = SET_ADDR(reg_addr, pctl);  in mtk_gpio_set()
103 		reg_addr = CLR_ADDR(reg_addr, pctl);  in mtk_gpio_set()
105 	regmap_write(mtk_get_regmap(pctl, offset), reg_addr, bit);  in mtk_gpio_set()
108 static int mtk_pconf_set_ies_smt(struct mtk_pinctrl *pctl, unsigned pin,  in mtk_pconf_set_ies_smt()  argument
118 	if (!pctl->devdata->spec_ies_smt_set &&  in mtk_pconf_set_ies_smt()
119 		pctl->devdata->ies_offset == MTK_PINCTRL_NOT_SUPPORT &&  in mtk_pconf_set_ies_smt()
123 	if (!pctl->devdata->spec_ies_smt_set &&  in mtk_pconf_set_ies_smt()
124 		pctl->devdata->smt_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 		return pctl->devdata->spec_ies_smt_set(mtk_get_regmap(pctl, pin),  in mtk_pconf_set_ies_smt()
134 			pin, pctl->devdata->port_align, value, arg);  in mtk_pconf_set_ies_smt()
138 		offset = pctl->devdata->ies_offset;  in mtk_pconf_set_ies_smt()
140 		offset = pctl->devdata->smt_offset;  in mtk_pconf_set_ies_smt()
142 	bit = BIT(offset & pctl->devdata->mode_mask);  in mtk_pconf_set_ies_smt()
145 		reg_addr = SET_ADDR(mtk_get_port(pctl, pin) + offset, pctl);  in mtk_pconf_set_ies_smt()
147 		reg_addr = CLR_ADDR(mtk_get_port(pctl, pin) + offset, pctl);  in mtk_pconf_set_ies_smt()
149 	regmap_write(mtk_get_regmap(pctl, pin), reg_addr, bit);  in mtk_pconf_set_ies_smt()
180 		struct mtk_pinctrl *pctl,  unsigned long pin) {  in mtk_find_pin_drv_grp_by_pin()  argument
183 	for (i = 0; i < pctl->devdata->n_pin_drv_grps; i++) {  in mtk_find_pin_drv_grp_by_pin()
185 				pctl->devdata->pin_drv_grp + i;  in mtk_find_pin_drv_grp_by_pin()
193 static int mtk_pconf_set_driving(struct mtk_pinctrl *pctl,  in mtk_pconf_set_driving()  argument
201 	if (pin >= pctl->devdata->npins)  in mtk_pconf_set_driving()
204 	pin_drv = mtk_find_pin_drv_grp_by_pin(pctl, pin);  in mtk_pconf_set_driving()
205 	if (!pin_drv || pin_drv->grp > pctl->devdata->n_grp_cls)  in mtk_pconf_set_driving()
208 	drv_grp = pctl->devdata->grp_desc + pin_drv->grp;  in mtk_pconf_set_driving()
217 		return regmap_update_bits(mtk_get_regmap(pctl, pin),  in mtk_pconf_set_driving()
284 static int mtk_pconf_set_pull_select(struct mtk_pinctrl *pctl,  in mtk_pconf_set_pull_select()  argument
295 	if (pctl->devdata->spec_pull_set) {  in mtk_pconf_set_pull_select()
300 		ret = pctl->devdata->spec_pull_set(mtk_get_regmap(pctl, pin),  in mtk_pconf_set_pull_select()
301 			pin, pctl->devdata->port_align, isup, r1r0);  in mtk_pconf_set_pull_select()
308 		dev_err(pctl->dev, "invalid pull-up argument %d on pin %d .\n",  in mtk_pconf_set_pull_select()
313 	bit = BIT(pin & pctl->devdata->mode_mask);  in mtk_pconf_set_pull_select()
315 		reg_pullen = SET_ADDR(mtk_get_port(pctl, pin) +  in mtk_pconf_set_pull_select()
316 			pctl->devdata->pullen_offset, pctl);  in mtk_pconf_set_pull_select()
318 		reg_pullen = CLR_ADDR(mtk_get_port(pctl, pin) +  in mtk_pconf_set_pull_select()
319 			pctl->devdata->pullen_offset, pctl);  in mtk_pconf_set_pull_select()
322 		reg_pullsel = SET_ADDR(mtk_get_port(pctl, pin) +  in mtk_pconf_set_pull_select()
323 			pctl->devdata->pullsel_offset, pctl);  in mtk_pconf_set_pull_select()
325 		reg_pullsel = CLR_ADDR(mtk_get_port(pctl, pin) +  in mtk_pconf_set_pull_select()
326 			pctl->devdata->pullsel_offset, pctl);  in mtk_pconf_set_pull_select()
328 	regmap_write(mtk_get_regmap(pctl, pin), reg_pullen, bit);  in mtk_pconf_set_pull_select()
329 	regmap_write(mtk_get_regmap(pctl, pin), reg_pullsel, bit);  in mtk_pconf_set_pull_select()
338 	struct mtk_pinctrl *pctl = pinctrl_dev_get_drvdata(pctldev);  in mtk_pconf_parse_conf()  local
342 		ret = mtk_pconf_set_pull_select(pctl, pin, false, false, arg);  in mtk_pconf_parse_conf()
345 		ret = mtk_pconf_set_pull_select(pctl, pin, true, true, arg);  in mtk_pconf_parse_conf()
348 		ret = mtk_pconf_set_pull_select(pctl, pin, true, false, arg);  in mtk_pconf_parse_conf()
352 		ret = mtk_pconf_set_ies_smt(pctl, pin, arg, param);  in mtk_pconf_parse_conf()
355 		mtk_gpio_set(pctl->chip, pin, arg);  in mtk_pconf_parse_conf()
360 		ret = mtk_pconf_set_ies_smt(pctl, pin, arg, param);  in mtk_pconf_parse_conf()
363 		ret = mtk_pconf_set_driving(pctl, pin, arg);  in mtk_pconf_parse_conf()
376 	struct mtk_pinctrl *pctl = pinctrl_dev_get_drvdata(pctldev);  in mtk_pconf_group_get()  local
378 	*config = pctl->groups[group].config;  in mtk_pconf_group_get()
386 	struct mtk_pinctrl *pctl = pinctrl_dev_get_drvdata(pctldev);  in mtk_pconf_group_set()  local
387 	struct mtk_pinctrl_group *g = &pctl->groups[group];  in mtk_pconf_group_set()
409 mtk_pctrl_find_group_by_pin(struct mtk_pinctrl *pctl, u32 pin)  in mtk_pctrl_find_group_by_pin()  argument
413 	for (i = 0; i < pctl->ngroups; i++) {  in mtk_pctrl_find_group_by_pin()
414 		struct mtk_pinctrl_group *grp = pctl->groups + i;  in mtk_pctrl_find_group_by_pin()
424 		struct mtk_pinctrl *pctl, u32 pin_num, u32 fnum)  in mtk_pctrl_find_function_by_pin()  argument
426 	const struct mtk_desc_pin *pin = pctl->devdata->pins + pin_num;  in mtk_pctrl_find_function_by_pin()
438 static bool mtk_pctrl_is_function_valid(struct mtk_pinctrl *pctl,  in mtk_pctrl_is_function_valid()  argument
443 	for (i = 0; i < pctl->devdata->npins; i++) {  in mtk_pctrl_is_function_valid()
444 		const struct mtk_desc_pin *pin = pctl->devdata->pins + i;  in mtk_pctrl_is_function_valid()
463 static int mtk_pctrl_dt_node_to_map_func(struct mtk_pinctrl *pctl,  in mtk_pctrl_dt_node_to_map_func()  argument
476 	ret = mtk_pctrl_is_function_valid(pctl, pin, fnum);  in mtk_pctrl_dt_node_to_map_func()
478 		dev_err(pctl->dev, "invalid function %d on pin %d .\n",  in mtk_pctrl_dt_node_to_map_func()
504 	struct mtk_pinctrl *pctl = pinctrl_dev_get_drvdata(pctldev);  in mtk_pctrl_dt_subnode_to_map()  local
508 		dev_err(pctl->dev, "missing pins property in node %pOFn .\n",  in mtk_pctrl_dt_subnode_to_map()
550 		if (pin >= pctl->devdata->npins ||  in mtk_pctrl_dt_subnode_to_map()
552 			dev_err(pctl->dev, "invalid pins value.\n");  in mtk_pctrl_dt_subnode_to_map()
557 		grp = mtk_pctrl_find_group_by_pin(pctl, pin);  in mtk_pctrl_dt_subnode_to_map()
559 			dev_err(pctl->dev, "unable to match pin %d to group\n",  in mtk_pctrl_dt_subnode_to_map()
565 		err = mtk_pctrl_dt_node_to_map_func(pctl, pin, func, grp, map,  in mtk_pctrl_dt_subnode_to_map()
614 	struct mtk_pinctrl *pctl = pinctrl_dev_get_drvdata(pctldev);  in mtk_pctrl_get_groups_count()  local
616 	return pctl->ngroups;  in mtk_pctrl_get_groups_count()
622 	struct mtk_pinctrl *pctl = pinctrl_dev_get_drvdata(pctldev);  in mtk_pctrl_get_group_name()  local
624 	return pctl->groups[group].name;  in mtk_pctrl_get_group_name()
632 	struct mtk_pinctrl *pctl = pinctrl_dev_get_drvdata(pctldev);  in mtk_pctrl_get_group_pins()  local
634 	*pins = (unsigned *)&pctl->groups[group].pin;  in mtk_pctrl_get_group_pins()
664 	struct mtk_pinctrl *pctl = pinctrl_dev_get_drvdata(pctldev);  in mtk_pmx_get_func_groups()  local
666 	*groups = pctl->grp_names;  in mtk_pmx_get_func_groups()
667 	*num_groups = pctl->ngroups;  in mtk_pmx_get_func_groups()
679 	struct mtk_pinctrl *pctl = pinctrl_dev_get_drvdata(pctldev);  in mtk_pmx_set_mode()  local
681 	if (pctl->devdata->spec_pinmux_set)  in mtk_pmx_set_mode()
682 		pctl->devdata->spec_pinmux_set(mtk_get_regmap(pctl, pin),  in mtk_pmx_set_mode()
685 	reg_addr = ((pin / pctl->devdata->mode_per_reg) << pctl->devdata->port_shf)  in mtk_pmx_set_mode()
686 			+ pctl->devdata->pinmux_offset;  in mtk_pmx_set_mode()
689 	bit = pin % pctl->devdata->mode_per_reg;  in mtk_pmx_set_mode()
692 	return regmap_update_bits(mtk_get_regmap(pctl, pin),  in mtk_pmx_set_mode()
697 mtk_find_pin_by_eint_num(struct mtk_pinctrl *pctl, unsigned int eint_num)  in mtk_find_pin_by_eint_num()  argument
702 	for (i = 0; i < pctl->devdata->npins; i++) {  in mtk_find_pin_by_eint_num()
703 		pin = pctl->devdata->pins + i;  in mtk_find_pin_by_eint_num()
717 	struct mtk_pinctrl *pctl = pinctrl_dev_get_drvdata(pctldev);  in mtk_pmx_set_mux()  local
718 	struct mtk_pinctrl_group *g = pctl->groups + group;  in mtk_pmx_set_mux()
720 	ret = mtk_pctrl_is_function_valid(pctl, g->pin, function);  in mtk_pmx_set_mux()
722 		dev_err(pctl->dev, "invalid function %d on group %d .\n",  in mtk_pmx_set_mux()
727 	desc = mtk_pctrl_find_function_by_pin(pctl, g->pin, function);  in mtk_pmx_set_mux()
734 static int mtk_pmx_find_gpio_mode(struct mtk_pinctrl *pctl,  in mtk_pmx_find_gpio_mode()  argument
737 	const struct mtk_desc_pin *pin = pctl->devdata->pins + offset;  in mtk_pmx_find_gpio_mode()
754 	struct mtk_pinctrl *pctl = pinctrl_dev_get_drvdata(pctldev);  in mtk_pmx_gpio_request_enable()  local
756 	muxval = mtk_pmx_find_gpio_mode(pctl, offset);  in mtk_pmx_gpio_request_enable()
759 		dev_err(pctl->dev, "invalid gpio pin %d.\n", offset);  in mtk_pmx_gpio_request_enable()
764 	mtk_pconf_set_ies_smt(pctl, offset, 1, PIN_CONFIG_INPUT_ENABLE);  in mtk_pmx_gpio_request_enable()
797 	struct mtk_pinctrl *pctl = gpiochip_get_data(chip);  in mtk_gpio_get_direction()  local
799 	reg_addr =  mtk_get_port(pctl, offset) + pctl->devdata->dir_offset;  in mtk_gpio_get_direction()
800 	bit = BIT(offset & pctl->devdata->mode_mask);  in mtk_gpio_get_direction()
802 	if (pctl->devdata->spec_dir_set)  in mtk_gpio_get_direction()
803 		pctl->devdata->spec_dir_set(&reg_addr, offset);  in mtk_gpio_get_direction()
805 	regmap_read(pctl->regmap1, reg_addr, &read_val);  in mtk_gpio_get_direction()
817 	struct mtk_pinctrl *pctl = gpiochip_get_data(chip);  in mtk_gpio_get()  local
819 	reg_addr = mtk_get_port(pctl, offset) +  in mtk_gpio_get()
820 		pctl->devdata->din_offset;  in mtk_gpio_get()
822 	bit = BIT(offset & pctl->devdata->mode_mask);  in mtk_gpio_get()
823 	regmap_read(pctl->regmap1, reg_addr, &read_val);  in mtk_gpio_get()
829 	struct mtk_pinctrl *pctl = gpiochip_get_data(chip);  in mtk_gpio_to_irq()  local
833 	pin = pctl->devdata->pins + offset;  in mtk_gpio_to_irq()
839 	return mtk_eint_find_irq(pctl->eint, eint_n);  in mtk_gpio_to_irq()
845 	struct mtk_pinctrl *pctl = gpiochip_get_data(chip);  in mtk_gpio_set_config()  local
853 	pin = pctl->devdata->pins + offset;  in mtk_gpio_set_config()
860 	return mtk_eint_set_debounce(pctl->eint, eint_n, debounce);  in mtk_gpio_set_config()
879 	struct mtk_pinctrl *pctl = dev_get_drvdata(device);  in mtk_eint_suspend()  local
881 	return mtk_eint_do_suspend(pctl->eint);  in mtk_eint_suspend()
886 	struct mtk_pinctrl *pctl = dev_get_drvdata(device);  in mtk_eint_resume()  local
888 	return mtk_eint_do_resume(pctl->eint);  in mtk_eint_resume()
898 	struct mtk_pinctrl *pctl = platform_get_drvdata(pdev);  in mtk_pctrl_build_state()  local
901 	pctl->ngroups = pctl->devdata->npins;  in mtk_pctrl_build_state()
904 	pctl->groups = devm_kcalloc(&pdev->dev, pctl->ngroups,  in mtk_pctrl_build_state()
905 				    sizeof(*pctl->groups), GFP_KERNEL);  in mtk_pctrl_build_state()
906 	if (!pctl->groups)  in mtk_pctrl_build_state()
910 	pctl->grp_names = devm_kcalloc(&pdev->dev, pctl->ngroups,  in mtk_pctrl_build_state()
911 				       sizeof(*pctl->grp_names), GFP_KERNEL);  in mtk_pctrl_build_state()
912 	if (!pctl->grp_names)  in mtk_pctrl_build_state()
915 	for (i = 0; i < pctl->devdata->npins; i++) {  in mtk_pctrl_build_state()
916 		const struct mtk_desc_pin *pin = pctl->devdata->pins + i;  in mtk_pctrl_build_state()
917 		struct mtk_pinctrl_group *group = pctl->groups + i;  in mtk_pctrl_build_state()
922 		pctl->grp_names[i] = pin->pin.name;  in mtk_pctrl_build_state()
932 	struct mtk_pinctrl *pctl = (struct mtk_pinctrl *)data;  in mtk_xt_get_gpio_n()  local
935 	pin = mtk_find_pin_by_eint_num(pctl, eint_n);  in mtk_xt_get_gpio_n()
939 	*gpio_chip = pctl->chip;  in mtk_xt_get_gpio_n()
947 	struct mtk_pinctrl *pctl = (struct mtk_pinctrl *)data;  in mtk_xt_get_gpio_state()  local
950 	pin = mtk_find_pin_by_eint_num(pctl, eint_n);  in mtk_xt_get_gpio_state()
954 	return mtk_gpio_get(pctl->chip, pin->pin.number);  in mtk_xt_get_gpio_state()
959 	struct mtk_pinctrl *pctl = (struct mtk_pinctrl *)data;  in mtk_xt_set_gpio_as_eint()  local
962 	pin = mtk_find_pin_by_eint_num(pctl, eint_n);  in mtk_xt_set_gpio_as_eint()
967 	mtk_pmx_set_mode(pctl->pctl_dev, pin->pin.number, pin->eint.eintmux);  in mtk_xt_set_gpio_as_eint()
969 	mtk_pmx_gpio_set_direction(pctl->pctl_dev, NULL, pin->pin.number,  in mtk_xt_set_gpio_as_eint()
972 	mtk_pconf_set_ies_smt(pctl, pin->pin.number, 1,  in mtk_xt_set_gpio_as_eint()
984 static int mtk_eint_init(struct mtk_pinctrl *pctl, struct platform_device *pdev)  in mtk_eint_init()  argument
991 	pctl->eint = devm_kzalloc(pctl->dev, sizeof(*pctl->eint), GFP_KERNEL);  in mtk_eint_init()
992 	if (!pctl->eint)  in mtk_eint_init()
995 	pctl->eint->base = devm_platform_ioremap_resource(pdev, 0);  in mtk_eint_init()
996 	if (IS_ERR(pctl->eint->base))  in mtk_eint_init()
997 		return PTR_ERR(pctl->eint->base);  in mtk_eint_init()
999 	pctl->eint->irq = irq_of_parse_and_map(np, 0);  in mtk_eint_init()
1000 	if (!pctl->eint->irq)  in mtk_eint_init()
1003 	pctl->eint->dev = &pdev->dev;  in mtk_eint_init()
1008 	pctl->eint->regs = pctl->devdata->eint_regs;  in mtk_eint_init()
1009 	pctl->eint->hw = &pctl->devdata->eint_hw;  in mtk_eint_init()
1010 	pctl->eint->pctl = pctl;  in mtk_eint_init()
1011 	pctl->eint->gpio_xlate = &mtk_eint_xt;  in mtk_eint_init()
1013 	return mtk_eint_do_init(pctl->eint);  in mtk_eint_init()
1021 	struct mtk_pinctrl *pctl;  in mtk_pctrl_init()  local
1026 	pctl = devm_kzalloc(&pdev->dev, sizeof(*pctl), GFP_KERNEL);  in mtk_pctrl_init()
1027 	if (!pctl)  in mtk_pctrl_init()
1030 	platform_set_drvdata(pdev, pctl);  in mtk_pctrl_init()
1040 		pctl->regmap1 = syscon_node_to_regmap(node);  in mtk_pctrl_init()
1041 		if (IS_ERR(pctl->regmap1))  in mtk_pctrl_init()
1042 			return PTR_ERR(pctl->regmap1);  in mtk_pctrl_init()
1044 		pctl->regmap1  = regmap;  in mtk_pctrl_init()
1053 		pctl->regmap2 = syscon_node_to_regmap(node);  in mtk_pctrl_init()
1054 		if (IS_ERR(pctl->regmap2))  in mtk_pctrl_init()
1055 			return PTR_ERR(pctl->regmap2);  in mtk_pctrl_init()
1058 	pctl->devdata = data;  in mtk_pctrl_init()
1065 	pins = devm_kcalloc(&pdev->dev, pctl->devdata->npins, sizeof(*pins),  in mtk_pctrl_init()
1070 	for (i = 0; i < pctl->devdata->npins; i++)  in mtk_pctrl_init()
1071 		pins[i] = pctl->devdata->pins[i].pin;  in mtk_pctrl_init()
1073 	pctl->pctl_desc.name = dev_name(&pdev->dev);  in mtk_pctrl_init()
1074 	pctl->pctl_desc.owner = THIS_MODULE;  in mtk_pctrl_init()
1075 	pctl->pctl_desc.pins = pins;  in mtk_pctrl_init()
1076 	pctl->pctl_desc.npins = pctl->devdata->npins;  in mtk_pctrl_init()
1077 	pctl->pctl_desc.confops = &mtk_pconf_ops;  in mtk_pctrl_init()
1078 	pctl->pctl_desc.pctlops = &mtk_pctrl_ops;  in mtk_pctrl_init()
1079 	pctl->pctl_desc.pmxops = &mtk_pmx_ops;  in mtk_pctrl_init()
1080 	pctl->dev = &pdev->dev;  in mtk_pctrl_init()
1082 	pctl->pctl_dev = devm_pinctrl_register(&pdev->dev, &pctl->pctl_desc,  in mtk_pctrl_init()
1083 					       pctl);  in mtk_pctrl_init()
1084 	if (IS_ERR(pctl->pctl_dev)) {  in mtk_pctrl_init()
1086 		return PTR_ERR(pctl->pctl_dev);  in mtk_pctrl_init()
1089 	pctl->chip = devm_kzalloc(&pdev->dev, sizeof(*pctl->chip), GFP_KERNEL);  in mtk_pctrl_init()
1090 	if (!pctl->chip)  in mtk_pctrl_init()
1093 	*pctl->chip = mtk_gpio_chip;  in mtk_pctrl_init()
1094 	pctl->chip->ngpio = pctl->devdata->npins;  in mtk_pctrl_init()
1095 	pctl->chip->label = dev_name(&pdev->dev);  in mtk_pctrl_init()
1096 	pctl->chip->parent = &pdev->dev;  in mtk_pctrl_init()
1097 	pctl->chip->base = -1;  in mtk_pctrl_init()
1099 	ret = gpiochip_add_data(pctl->chip, pctl);  in mtk_pctrl_init()
1104 	ret = gpiochip_add_pin_range(pctl->chip, dev_name(&pdev->dev),  in mtk_pctrl_init()
1105 			0, 0, pctl->devdata->npins);  in mtk_pctrl_init()
1111 	ret = mtk_eint_init(pctl, pdev);  in mtk_pctrl_init()
1118 	gpiochip_remove(pctl->chip);  in mtk_pctrl_init()