Lines Matching +full:pctl +full:- +full:regmap
1 // SPDX-License-Identifier: GPL-2.0-only
17 #include <linux/pinctrl/pinconf-generic.h>
23 #include <linux/regmap.h>
28 #include <dt-bindings/pinctrl/mt65xx.h>
32 #include "../pinctrl-utils.h"
33 #include "mtk-eint.h"
34 #include "pinctrl-mtk-common.h"
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(®_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()
122 return -EINVAL; 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()
127 return -EINVAL; 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()
154 int mtk_pconf_spec_set_ies_smt_range(struct regmap *regmap, in mtk_pconf_spec_set_ies_smt_range() argument
168 return -EINVAL; in mtk_pconf_spec_set_ies_smt_range()
176 regmap_write(regmap, reg_addr, bit); in mtk_pconf_spec_set_ies_smt_range()
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()
187 if (pin == pin_drv->pin) 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()
203 return -EINVAL; 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()
207 return -EINVAL; in mtk_pconf_set_driving()
209 drv_grp = pctl->devdata->grp_desc + pin_drv->grp; in mtk_pconf_set_driving()
210 if (driving >= drv_grp->min_drv && driving <= drv_grp->max_drv in mtk_pconf_set_driving()
211 && !(driving % drv_grp->step)) { in mtk_pconf_set_driving()
212 val = driving / drv_grp->step - 1; in mtk_pconf_set_driving()
213 bits = drv_grp->high_bit - drv_grp->low_bit + 1; in mtk_pconf_set_driving()
214 mask = BIT(bits) - 1; in mtk_pconf_set_driving()
215 shift = pin_drv->bit + drv_grp->low_bit; in mtk_pconf_set_driving()
218 return regmap_update_bits(mtk_get_regmap(pctl, pin), in mtk_pconf_set_driving()
219 pin_drv->offset, mask, val); in mtk_pconf_set_driving()
222 return -EINVAL; in mtk_pconf_set_driving()
225 int mtk_pctrl_spec_pull_set_samereg(struct regmap *regmap, in mtk_pctrl_spec_pull_set_samereg() argument
244 return -EINVAL; in mtk_pctrl_spec_pull_set_samereg()
247 reg_set = spec_pupd_pin->offset + align; in mtk_pctrl_spec_pull_set_samereg()
248 reg_rst = spec_pupd_pin->offset + (align << 1); in mtk_pctrl_spec_pull_set_samereg()
255 bit_pupd = BIT(spec_pupd_pin->pupd_bit); in mtk_pctrl_spec_pull_set_samereg()
256 regmap_write(regmap, reg_pupd, bit_pupd); in mtk_pctrl_spec_pull_set_samereg()
258 bit_r0 = BIT(spec_pupd_pin->r0_bit); in mtk_pctrl_spec_pull_set_samereg()
259 bit_r1 = BIT(spec_pupd_pin->r1_bit); in mtk_pctrl_spec_pull_set_samereg()
263 regmap_write(regmap, reg_rst, bit_r0); in mtk_pctrl_spec_pull_set_samereg()
264 regmap_write(regmap, reg_rst, bit_r1); in mtk_pctrl_spec_pull_set_samereg()
267 regmap_write(regmap, reg_set, bit_r0); in mtk_pctrl_spec_pull_set_samereg()
268 regmap_write(regmap, reg_rst, bit_r1); in mtk_pctrl_spec_pull_set_samereg()
271 regmap_write(regmap, reg_rst, bit_r0); in mtk_pctrl_spec_pull_set_samereg()
272 regmap_write(regmap, reg_set, bit_r1); in mtk_pctrl_spec_pull_set_samereg()
275 regmap_write(regmap, reg_set, bit_r0); in mtk_pctrl_spec_pull_set_samereg()
276 regmap_write(regmap, reg_set, bit_r1); in mtk_pctrl_spec_pull_set_samereg()
279 return -EINVAL; in mtk_pctrl_spec_pull_set_samereg()
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()
297 /* For special pins, bias-disable is set by R1R0, 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()
311 return -EINVAL; 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()
367 ret = -EINVAL; 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()
392 ret = mtk_pconf_parse_conf(pctldev, g->pin, in mtk_pconf_group_set()
398 g->config = configs[i]; 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()
417 if (grp->pin == pin) 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()
428 const struct mtk_desc_function *func = pin->functions; in mtk_pctrl_find_function_by_pin()
430 while (func && func->name) { in mtk_pctrl_find_function_by_pin()
431 if (func->muxval == fnum) 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()
447 if (pin->pin.number == pin_num) { in mtk_pctrl_is_function_valid()
449 pin->functions; in mtk_pctrl_is_function_valid()
451 while (func && func->name) { in mtk_pctrl_is_function_valid()
452 if (func->muxval == fnum) 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
472 return -ENOSPC; in mtk_pctrl_dt_node_to_map_func()
475 (*map)[*num_maps].data.mux.group = grp->name; in mtk_pctrl_dt_node_to_map_func()
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()
481 return -EINVAL; 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()
511 return -EINVAL; in mtk_pctrl_dt_subnode_to_map()
522 num_pins = pins->length / sizeof(u32); in mtk_pctrl_dt_subnode_to_map()
531 err = -EINVAL; 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()
554 err = -EINVAL; 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()
562 err = -EINVAL; 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()
573 reserved_maps, num_maps, grp->name, 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()
679 unsigned int mask = (1L << GPIO_MODE_BITS) - 1; in mtk_pmx_set_mode()
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()
705 if (pin->eint.eintnum == eint_num) 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()
725 return -EINVAL; in mtk_pmx_set_mux()
728 desc = mtk_pctrl_find_function_by_pin(pctl, g->pin, function); in mtk_pmx_set_mux()
730 return -EINVAL; in mtk_pmx_set_mux()
731 mtk_pmx_set_mode(pctldev, g->pin, desc->muxval); 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()
739 const struct mtk_desc_function *func = pin->functions; in mtk_pmx_find_gpio_mode()
741 while (func && func->name) { in mtk_pmx_find_gpio_mode()
742 if (!strncmp(func->name, GPIO_MODE_PREFIX, in mtk_pmx_find_gpio_mode()
743 sizeof(GPIO_MODE_PREFIX)-1)) in mtk_pmx_find_gpio_mode()
744 return func->muxval; in mtk_pmx_find_gpio_mode()
747 return -EINVAL; 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()
761 return -EINVAL; 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()
782 return pinctrl_gpio_direction_input(chip->base + offset); in mtk_gpio_direction_input()
789 return pinctrl_gpio_direction_output(chip->base + offset); in mtk_gpio_direction_output()
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(®_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()
835 if (pin->eint.eintnum == NO_EINT_SUPPORT) in mtk_gpio_to_irq()
836 return -EINVAL; in mtk_gpio_to_irq()
838 eint_n = pin->eint.eintnum; 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
852 return -ENOTSUPP; in mtk_gpio_set_config()
854 pin = pctl->devdata->pins + offset; in mtk_gpio_set_config()
855 if (pin->eint.eintnum == NO_EINT_SUPPORT) in mtk_gpio_set_config()
856 return -EINVAL; in mtk_gpio_set_config()
859 eint_n = pin->eint.eintnum; 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()
908 return -ENOMEM; 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()
914 return -ENOMEM; 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()
920 group->name = pin->pin.name; in mtk_pctrl_build_state()
921 group->pin = pin->pin.number; 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()
938 return -EINVAL; in mtk_xt_get_gpio_n()
940 *gpio_chip = pctl->chip; in mtk_xt_get_gpio_n()
941 *gpio_n = pin->pin.number; 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()
953 return -EINVAL; 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()
965 return -EINVAL; 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()
972 /* set input-enable */ 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
987 struct device_node *np = pdev->dev.of_node; in mtk_eint_init()
989 if (!of_property_read_bool(np, "interrupt-controller")) in mtk_eint_init()
990 return -ENODEV; in mtk_eint_init()
992 pctl->eint = devm_kzalloc(pctl->dev, sizeof(*pctl->eint), GFP_KERNEL); in mtk_eint_init()
993 if (!pctl->eint) in mtk_eint_init()
994 return -ENOMEM; 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()
1002 return -EINVAL; in mtk_eint_init()
1004 pctl->eint->dev = &pdev->dev; in mtk_eint_init()
1006 * If pctl->eint->regs == NULL, it would fall back into using a generic 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()
1019 struct regmap *regmap) in mtk_pctrl_init() argument
1022 struct mtk_pinctrl *pctl; in mtk_pctrl_init() local
1023 struct device_node *np = pdev->dev.of_node, *node; in mtk_pctrl_init()
1027 pctl = devm_kzalloc(&pdev->dev, sizeof(*pctl), GFP_KERNEL); in mtk_pctrl_init()
1028 if (!pctl) in mtk_pctrl_init()
1029 return -ENOMEM; in mtk_pctrl_init()
1031 platform_set_drvdata(pdev, pctl); in mtk_pctrl_init()
1033 prop = of_find_property(np, "pins-are-numbered", NULL); in mtk_pctrl_init()
1035 dev_err(&pdev->dev, "only support pins-are-numbered format\n"); in mtk_pctrl_init()
1036 return -EINVAL; in mtk_pctrl_init()
1039 node = of_parse_phandle(np, "mediatek,pctl-regmap", 0); in mtk_pctrl_init()
1041 pctl->regmap1 = syscon_node_to_regmap(node); in mtk_pctrl_init()
1043 if (IS_ERR(pctl->regmap1)) in mtk_pctrl_init()
1044 return PTR_ERR(pctl->regmap1); in mtk_pctrl_init()
1045 } else if (regmap) { in mtk_pctrl_init()
1046 pctl->regmap1 = regmap; in mtk_pctrl_init()
1048 dev_err(&pdev->dev, "Pinctrl node has not register regmap.\n"); in mtk_pctrl_init()
1049 return -EINVAL; in mtk_pctrl_init()
1053 node = of_parse_phandle(np, "mediatek,pctl-regmap", 1); in mtk_pctrl_init()
1055 pctl->regmap2 = syscon_node_to_regmap(node); in mtk_pctrl_init()
1057 if (IS_ERR(pctl->regmap2)) in mtk_pctrl_init()
1058 return PTR_ERR(pctl->regmap2); in mtk_pctrl_init()
1061 pctl->devdata = data; in mtk_pctrl_init()
1064 dev_err(&pdev->dev, "build state failed: %d\n", ret); in mtk_pctrl_init()
1065 return -EINVAL; in mtk_pctrl_init()
1068 pins = devm_kcalloc(&pdev->dev, pctl->devdata->npins, sizeof(*pins), in mtk_pctrl_init()
1071 return -ENOMEM; in mtk_pctrl_init()
1073 for (i = 0; i < pctl->devdata->npins; i++) in mtk_pctrl_init()
1074 pins[i] = pctl->devdata->pins[i].pin; in mtk_pctrl_init()
1076 pctl->pctl_desc.name = dev_name(&pdev->dev); in mtk_pctrl_init()
1077 pctl->pctl_desc.owner = THIS_MODULE; in mtk_pctrl_init()
1078 pctl->pctl_desc.pins = pins; in mtk_pctrl_init()
1079 pctl->pctl_desc.npins = pctl->devdata->npins; in mtk_pctrl_init()
1080 pctl->pctl_desc.confops = &mtk_pconf_ops; in mtk_pctrl_init()
1081 pctl->pctl_desc.pctlops = &mtk_pctrl_ops; in mtk_pctrl_init()
1082 pctl->pctl_desc.pmxops = &mtk_pmx_ops; in mtk_pctrl_init()
1083 pctl->dev = &pdev->dev; in mtk_pctrl_init()
1085 pctl->pctl_dev = devm_pinctrl_register(&pdev->dev, &pctl->pctl_desc, in mtk_pctrl_init()
1086 pctl); in mtk_pctrl_init()
1087 if (IS_ERR(pctl->pctl_dev)) { in mtk_pctrl_init()
1088 dev_err(&pdev->dev, "couldn't register pinctrl driver\n"); in mtk_pctrl_init()
1089 return PTR_ERR(pctl->pctl_dev); in mtk_pctrl_init()
1092 pctl->chip = devm_kzalloc(&pdev->dev, sizeof(*pctl->chip), GFP_KERNEL); in mtk_pctrl_init()
1093 if (!pctl->chip) in mtk_pctrl_init()
1094 return -ENOMEM; in mtk_pctrl_init()
1096 *pctl->chip = mtk_gpio_chip; in mtk_pctrl_init()
1097 pctl->chip->ngpio = pctl->devdata->npins; in mtk_pctrl_init()
1098 pctl->chip->label = dev_name(&pdev->dev); in mtk_pctrl_init()
1099 pctl->chip->parent = &pdev->dev; in mtk_pctrl_init()
1100 pctl->chip->base = -1; in mtk_pctrl_init()
1102 ret = gpiochip_add_data(pctl->chip, pctl); in mtk_pctrl_init()
1104 return -EINVAL; in mtk_pctrl_init()
1107 ret = gpiochip_add_pin_range(pctl->chip, dev_name(&pdev->dev), in mtk_pctrl_init()
1108 0, 0, pctl->devdata->npins); in mtk_pctrl_init()
1110 ret = -EINVAL; in mtk_pctrl_init()
1114 ret = mtk_eint_init(pctl, pdev); in mtk_pctrl_init()
1121 gpiochip_remove(pctl->chip); in mtk_pctrl_init()