Lines Matching +full:soc +full:- +full:s
1 // SPDX-License-Identifier: GPL-2.0-or-later
6 * Thomas Petazzoni <thomas.petazzoni@free-electrons.com>
24 #include "pinctrl-mvebu.h"
64 *config = (readl(data->base + off) >> shift) & MVEBU_MPP_MASK; in mvebu_mmio_mpp_ctrl_get()
76 reg = readl(data->base + off) & ~(MVEBU_MPP_MASK << shift); in mvebu_mmio_mpp_ctrl_set()
77 writel(reg | (config << shift), data->base + off); in mvebu_mmio_mpp_ctrl_set()
86 for (n = 0; n < pctl->num_groups; n++) { in mvebu_pinctrl_find_group_by_pid()
87 if (pid >= pctl->groups[n].pins[0] && in mvebu_pinctrl_find_group_by_pid()
88 pid < pctl->groups[n].pins[0] + in mvebu_pinctrl_find_group_by_pid()
89 pctl->groups[n].npins) in mvebu_pinctrl_find_group_by_pid()
90 return &pctl->groups[n]; in mvebu_pinctrl_find_group_by_pid()
99 for (n = 0; n < pctl->num_groups; n++) { in mvebu_pinctrl_find_group_by_name()
100 if (strcmp(name, pctl->groups[n].name) == 0) in mvebu_pinctrl_find_group_by_name()
101 return &pctl->groups[n]; in mvebu_pinctrl_find_group_by_name()
111 for (n = 0; n < grp->num_settings; n++) { in mvebu_pinctrl_find_setting_by_val()
112 if (config == grp->settings[n].val) { in mvebu_pinctrl_find_setting_by_val()
113 if (!pctl->variant || (pctl->variant & in mvebu_pinctrl_find_setting_by_val()
114 grp->settings[n].variant)) in mvebu_pinctrl_find_setting_by_val()
115 return &grp->settings[n]; in mvebu_pinctrl_find_setting_by_val()
126 for (n = 0; n < grp->num_settings; n++) { in mvebu_pinctrl_find_setting_by_name()
127 if (strcmp(name, grp->settings[n].name) == 0) { in mvebu_pinctrl_find_setting_by_name()
128 if (!pctl->variant || (pctl->variant & in mvebu_pinctrl_find_setting_by_name()
129 grp->settings[n].variant)) in mvebu_pinctrl_find_setting_by_name()
130 return &grp->settings[n]; in mvebu_pinctrl_find_setting_by_name()
140 for (n = 0; n < grp->num_settings; n++) { in mvebu_pinctrl_find_gpio_setting()
141 if (grp->settings[n].flags & in mvebu_pinctrl_find_gpio_setting()
143 if (!pctl->variant || (pctl->variant & in mvebu_pinctrl_find_gpio_setting()
144 grp->settings[n].variant)) in mvebu_pinctrl_find_gpio_setting()
145 return &grp->settings[n]; in mvebu_pinctrl_find_gpio_setting()
155 for (n = 0; n < pctl->num_functions; n++) { in mvebu_pinctrl_find_function_by_name()
156 if (strcmp(name, pctl->functions[n].name) == 0) in mvebu_pinctrl_find_function_by_name()
157 return &pctl->functions[n]; in mvebu_pinctrl_find_function_by_name()
166 struct mvebu_pinctrl_group *grp = &pctl->groups[gid]; in mvebu_pinconf_group_get()
168 if (!grp->ctrl) in mvebu_pinconf_group_get()
169 return -EINVAL; in mvebu_pinconf_group_get()
171 return grp->ctrl->mpp_get(grp->data, grp->pins[0], config); in mvebu_pinconf_group_get()
179 struct mvebu_pinctrl_group *grp = &pctl->groups[gid]; in mvebu_pinconf_group_set()
182 if (!grp->ctrl) in mvebu_pinconf_group_set()
183 return -EINVAL; in mvebu_pinconf_group_set()
186 ret = grp->ctrl->mpp_set(grp->data, grp->pins[0], configs[i]); in mvebu_pinconf_group_set()
195 struct seq_file *s, unsigned gid) in mvebu_pinconf_group_dbg_show() argument
198 struct mvebu_pinctrl_group *grp = &pctl->groups[gid]; in mvebu_pinconf_group_dbg_show()
209 seq_printf(s, "current: %s", curr->name); in mvebu_pinconf_group_dbg_show()
210 if (curr->subname) in mvebu_pinconf_group_dbg_show()
211 seq_printf(s, "(%s)", curr->subname); in mvebu_pinconf_group_dbg_show()
212 if (curr->flags & (MVEBU_SETTING_GPO | MVEBU_SETTING_GPI)) { in mvebu_pinconf_group_dbg_show()
213 seq_putc(s, '('); in mvebu_pinconf_group_dbg_show()
214 if (curr->flags & MVEBU_SETTING_GPI) in mvebu_pinconf_group_dbg_show()
215 seq_putc(s, 'i'); in mvebu_pinconf_group_dbg_show()
216 if (curr->flags & MVEBU_SETTING_GPO) in mvebu_pinconf_group_dbg_show()
217 seq_putc(s, 'o'); in mvebu_pinconf_group_dbg_show()
218 seq_putc(s, ')'); in mvebu_pinconf_group_dbg_show()
221 seq_puts(s, "current: UNKNOWN"); in mvebu_pinconf_group_dbg_show()
224 if (grp->num_settings > 1) { in mvebu_pinconf_group_dbg_show()
225 seq_puts(s, ", available = ["); in mvebu_pinconf_group_dbg_show()
226 for (n = 0; n < grp->num_settings; n++) { in mvebu_pinconf_group_dbg_show()
227 if (curr == &grp->settings[n]) in mvebu_pinconf_group_dbg_show()
231 if (pctl->variant && in mvebu_pinconf_group_dbg_show()
232 !(pctl->variant & grp->settings[n].variant)) in mvebu_pinconf_group_dbg_show()
235 seq_printf(s, " %s", grp->settings[n].name); in mvebu_pinconf_group_dbg_show()
236 if (grp->settings[n].subname) in mvebu_pinconf_group_dbg_show()
237 seq_printf(s, "(%s)", grp->settings[n].subname); in mvebu_pinconf_group_dbg_show()
238 if (grp->settings[n].flags & in mvebu_pinconf_group_dbg_show()
240 seq_putc(s, '('); in mvebu_pinconf_group_dbg_show()
241 if (grp->settings[n].flags & MVEBU_SETTING_GPI) in mvebu_pinconf_group_dbg_show()
242 seq_putc(s, 'i'); in mvebu_pinconf_group_dbg_show()
243 if (grp->settings[n].flags & MVEBU_SETTING_GPO) in mvebu_pinconf_group_dbg_show()
244 seq_putc(s, 'o'); in mvebu_pinconf_group_dbg_show()
245 seq_putc(s, ')'); in mvebu_pinconf_group_dbg_show()
248 seq_puts(s, " ]"); in mvebu_pinconf_group_dbg_show()
262 return pctl->num_functions; in mvebu_pinmux_get_funcs_count()
270 return pctl->functions[fid].name; in mvebu_pinmux_get_func_name()
279 *groups = pctl->functions[fid].groups; in mvebu_pinmux_get_groups()
280 *num_groups = pctl->functions[fid].num_groups; in mvebu_pinmux_get_groups()
288 struct mvebu_pinctrl_function *func = &pctl->functions[fid]; in mvebu_pinmux_set()
289 struct mvebu_pinctrl_group *grp = &pctl->groups[gid]; in mvebu_pinmux_set()
295 func->name); in mvebu_pinmux_set()
297 dev_err(pctl->dev, in mvebu_pinmux_set()
298 "unable to find setting %s in group %s\n", in mvebu_pinmux_set()
299 func->name, func->groups[gid]); in mvebu_pinmux_set()
300 return -EINVAL; in mvebu_pinmux_set()
303 config = setting->val; in mvebu_pinmux_set()
304 ret = mvebu_pinconf_group_set(pctldev, grp->gid, &config, 1); in mvebu_pinmux_set()
306 dev_err(pctl->dev, "cannot set group %s to %s\n", in mvebu_pinmux_set()
307 func->groups[gid], func->name); in mvebu_pinmux_set()
324 return -EINVAL; in mvebu_pinmux_gpio_request_enable()
326 if (grp->ctrl->mpp_gpio_req) in mvebu_pinmux_gpio_request_enable()
327 return grp->ctrl->mpp_gpio_req(grp->data, offset); in mvebu_pinmux_gpio_request_enable()
331 return -ENOTSUPP; in mvebu_pinmux_gpio_request_enable()
333 config = setting->val; in mvebu_pinmux_gpio_request_enable()
335 return mvebu_pinconf_group_set(pctldev, grp->gid, &config, 1); in mvebu_pinmux_gpio_request_enable()
347 return -EINVAL; in mvebu_pinmux_gpio_set_direction()
349 if (grp->ctrl->mpp_gpio_dir) in mvebu_pinmux_gpio_set_direction()
350 return grp->ctrl->mpp_gpio_dir(grp->data, offset, input); in mvebu_pinmux_gpio_set_direction()
354 return -ENOTSUPP; in mvebu_pinmux_gpio_set_direction()
356 if ((input && (setting->flags & MVEBU_SETTING_GPI)) || in mvebu_pinmux_gpio_set_direction()
357 (!input && (setting->flags & MVEBU_SETTING_GPO))) in mvebu_pinmux_gpio_set_direction()
360 return -ENOTSUPP; in mvebu_pinmux_gpio_set_direction()
375 return pctl->num_groups; in mvebu_pinctrl_get_groups_count()
382 return pctl->groups[gid].name; in mvebu_pinctrl_get_group_name()
390 *pins = pctl->groups[gid].pins; in mvebu_pinctrl_get_group_pins()
391 *num_pins = pctl->groups[gid].npins; in mvebu_pinctrl_get_group_pins()
411 dev_err(pctl->dev, in mvebu_pinctrl_dt_node_to_map()
418 dev_err(pctl->dev, in mvebu_pinctrl_dt_node_to_map()
425 return -ENOMEM; in mvebu_pinctrl_dt_node_to_map()
433 dev_err(pctl->dev, "unknown pin %s", group); in mvebu_pinctrl_dt_node_to_map()
438 dev_err(pctl->dev, "unsupported function %s on pin %s", in mvebu_pinctrl_dt_node_to_map()
472 return -EOVERFLOW; in _add_function()
474 while (funcs->num_groups) { in _add_function()
476 if (strcmp(funcs->name, name) == 0) { in _add_function()
477 funcs->num_groups++; in _add_function()
478 return -EEXIST; in _add_function()
484 funcs->name = name; in _add_function()
485 funcs->num_groups = 1; in _add_function()
486 (*funcsize)--; in _add_function()
495 int num = 0, funcsize = pctl->desc.npins; in mvebu_pinctrl_build_functions()
496 int n, s; in mvebu_pinctrl_build_functions() local
500 funcs = devm_kcalloc(&pdev->dev, in mvebu_pinctrl_build_functions()
504 return -ENOMEM; in mvebu_pinctrl_build_functions()
506 for (n = 0; n < pctl->num_groups; n++) { in mvebu_pinctrl_build_functions()
507 struct mvebu_pinctrl_group *grp = &pctl->groups[n]; in mvebu_pinctrl_build_functions()
508 for (s = 0; s < grp->num_settings; s++) { in mvebu_pinctrl_build_functions()
512 if (pctl->variant && in mvebu_pinctrl_build_functions()
513 !(pctl->variant & grp->settings[s].variant)) in mvebu_pinctrl_build_functions()
518 grp->settings[s].name); in mvebu_pinctrl_build_functions()
519 if (ret == -EOVERFLOW) in mvebu_pinctrl_build_functions()
520 dev_err(&pdev->dev, in mvebu_pinctrl_build_functions()
522 pctl->desc.npins); in mvebu_pinctrl_build_functions()
530 pctl->num_functions = num; in mvebu_pinctrl_build_functions()
531 pctl->functions = funcs; in mvebu_pinctrl_build_functions()
533 for (n = 0; n < pctl->num_groups; n++) { in mvebu_pinctrl_build_functions()
534 struct mvebu_pinctrl_group *grp = &pctl->groups[n]; in mvebu_pinctrl_build_functions()
535 for (s = 0; s < grp->num_settings; s++) { in mvebu_pinctrl_build_functions()
540 if (pctl->variant && in mvebu_pinctrl_build_functions()
541 !(pctl->variant & grp->settings[s].variant)) in mvebu_pinctrl_build_functions()
545 grp->settings[s].name); in mvebu_pinctrl_build_functions()
548 if (!f->groups) { in mvebu_pinctrl_build_functions()
549 f->groups = devm_kcalloc(&pdev->dev, in mvebu_pinctrl_build_functions()
550 f->num_groups, in mvebu_pinctrl_build_functions()
553 if (!f->groups) in mvebu_pinctrl_build_functions()
554 return -ENOMEM; in mvebu_pinctrl_build_functions()
558 groups = f->groups; in mvebu_pinctrl_build_functions()
561 *groups = grp->name; in mvebu_pinctrl_build_functions()
570 struct mvebu_pinctrl_soc_info *soc = dev_get_platdata(&pdev->dev); in mvebu_pinctrl_probe() local
579 if (!soc || !soc->controls || !soc->modes) { in mvebu_pinctrl_probe()
580 dev_err(&pdev->dev, "wrong pinctrl soc info\n"); in mvebu_pinctrl_probe()
581 return -EINVAL; in mvebu_pinctrl_probe()
584 pctl = devm_kzalloc(&pdev->dev, sizeof(struct mvebu_pinctrl), in mvebu_pinctrl_probe()
587 return -ENOMEM; in mvebu_pinctrl_probe()
589 pctl->desc.name = dev_name(&pdev->dev); in mvebu_pinctrl_probe()
590 pctl->desc.owner = THIS_MODULE; in mvebu_pinctrl_probe()
591 pctl->desc.pctlops = &mvebu_pinctrl_ops; in mvebu_pinctrl_probe()
592 pctl->desc.pmxops = &mvebu_pinmux_ops; in mvebu_pinctrl_probe()
593 pctl->desc.confops = &mvebu_pinconf_ops; in mvebu_pinctrl_probe()
594 pctl->variant = soc->variant; in mvebu_pinctrl_probe()
595 pctl->dev = &pdev->dev; in mvebu_pinctrl_probe()
600 pctl->num_groups = 0; in mvebu_pinctrl_probe()
601 pctl->desc.npins = 0; in mvebu_pinctrl_probe()
602 for (n = 0; n < soc->ncontrols; n++) { in mvebu_pinctrl_probe()
603 const struct mvebu_mpp_ctrl *ctrl = &soc->controls[n]; in mvebu_pinctrl_probe()
605 pctl->desc.npins += ctrl->npins; in mvebu_pinctrl_probe()
606 /* initialize control's pins[] array */ in mvebu_pinctrl_probe()
607 for (k = 0; k < ctrl->npins; k++) in mvebu_pinctrl_probe()
608 ctrl->pins[k] = ctrl->pid + k; in mvebu_pinctrl_probe()
612 * as a range of one-pin groups with generic mvebu register in mvebu_pinctrl_probe()
615 if (!ctrl->name) { in mvebu_pinctrl_probe()
616 pctl->num_groups += ctrl->npins; in mvebu_pinctrl_probe()
617 noname += ctrl->npins; in mvebu_pinctrl_probe()
619 pctl->num_groups += 1; in mvebu_pinctrl_probe()
623 pdesc = devm_kcalloc(&pdev->dev, in mvebu_pinctrl_probe()
624 pctl->desc.npins, in mvebu_pinctrl_probe()
628 return -ENOMEM; in mvebu_pinctrl_probe()
630 for (n = 0; n < pctl->desc.npins; n++) in mvebu_pinctrl_probe()
632 pctl->desc.pins = pdesc; in mvebu_pinctrl_probe()
637 size = pctl->num_groups * sizeof(*pctl->groups) + noname * 8; in mvebu_pinctrl_probe()
638 p = devm_kzalloc(&pdev->dev, size, GFP_KERNEL); in mvebu_pinctrl_probe()
640 return -ENOMEM; in mvebu_pinctrl_probe()
642 pctl->groups = p; in mvebu_pinctrl_probe()
643 noname_buf = p + pctl->num_groups * sizeof(*pctl->groups); in mvebu_pinctrl_probe()
647 for (n = 0; n < soc->ncontrols; n++) { in mvebu_pinctrl_probe()
648 const struct mvebu_mpp_ctrl *ctrl = &soc->controls[n]; in mvebu_pinctrl_probe()
649 struct mvebu_mpp_ctrl_data *data = soc->control_data ? in mvebu_pinctrl_probe()
650 &soc->control_data[n] : NULL; in mvebu_pinctrl_probe()
652 pctl->groups[gid].gid = gid; in mvebu_pinctrl_probe()
653 pctl->groups[gid].ctrl = ctrl; in mvebu_pinctrl_probe()
654 pctl->groups[gid].data = data; in mvebu_pinctrl_probe()
655 pctl->groups[gid].name = ctrl->name; in mvebu_pinctrl_probe()
656 pctl->groups[gid].pins = ctrl->pins; in mvebu_pinctrl_probe()
657 pctl->groups[gid].npins = ctrl->npins; in mvebu_pinctrl_probe()
660 * We treat unnamed controls as a range of one-pin groups in mvebu_pinctrl_probe()
664 if (!ctrl->name) { in mvebu_pinctrl_probe()
665 pctl->groups[gid].name = noname_buf; in mvebu_pinctrl_probe()
666 pctl->groups[gid].npins = 1; in mvebu_pinctrl_probe()
667 sprintf(noname_buf, "mpp%d", ctrl->pid+0); in mvebu_pinctrl_probe()
670 for (k = 1; k < ctrl->npins; k++) { in mvebu_pinctrl_probe()
672 pctl->groups[gid].gid = gid; in mvebu_pinctrl_probe()
673 pctl->groups[gid].ctrl = ctrl; in mvebu_pinctrl_probe()
674 pctl->groups[gid].data = data; in mvebu_pinctrl_probe()
675 pctl->groups[gid].name = noname_buf; in mvebu_pinctrl_probe()
676 pctl->groups[gid].pins = &ctrl->pins[k]; in mvebu_pinctrl_probe()
677 pctl->groups[gid].npins = 1; in mvebu_pinctrl_probe()
678 sprintf(noname_buf, "mpp%d", ctrl->pid+k); in mvebu_pinctrl_probe()
686 for (n = 0; n < soc->nmodes; n++) { in mvebu_pinctrl_probe()
687 struct mvebu_mpp_mode *mode = &soc->modes[n]; in mvebu_pinctrl_probe()
688 struct mvebu_mpp_ctrl_setting *set = &mode->settings[0]; in mvebu_pinctrl_probe()
694 if (!set->name) in mvebu_pinctrl_probe()
700 if (pctl->variant && !(pctl->variant & set->variant)) in mvebu_pinctrl_probe()
706 if (strcmp(set->name, "gpio") == 0) in mvebu_pinctrl_probe()
707 set->flags = MVEBU_SETTING_GPI | in mvebu_pinctrl_probe()
709 else if (strcmp(set->name, "gpo") == 0) in mvebu_pinctrl_probe()
710 set->flags = MVEBU_SETTING_GPO; in mvebu_pinctrl_probe()
711 else if (strcmp(set->name, "gpi") == 0) in mvebu_pinctrl_probe()
712 set->flags = MVEBU_SETTING_GPI; in mvebu_pinctrl_probe()
719 grp = mvebu_pinctrl_find_group_by_pid(pctl, mode->pid); in mvebu_pinctrl_probe()
721 dev_warn(&pdev->dev, "unknown pinctrl group %d\n", in mvebu_pinctrl_probe()
722 mode->pid); in mvebu_pinctrl_probe()
726 grp->settings = mode->settings; in mvebu_pinctrl_probe()
727 grp->num_settings = num_settings; in mvebu_pinctrl_probe()
732 dev_err(&pdev->dev, "unable to build functions\n"); in mvebu_pinctrl_probe()
736 pctl->pctldev = devm_pinctrl_register(&pdev->dev, &pctl->desc, pctl); in mvebu_pinctrl_probe()
737 if (IS_ERR(pctl->pctldev)) { in mvebu_pinctrl_probe()
738 dev_err(&pdev->dev, "unable to register pinctrl driver\n"); in mvebu_pinctrl_probe()
739 return PTR_ERR(pctl->pctldev); in mvebu_pinctrl_probe()
742 dev_info(&pdev->dev, "registered pinctrl driver\n"); in mvebu_pinctrl_probe()
745 for (n = 0; n < soc->ngpioranges; n++) in mvebu_pinctrl_probe()
746 pinctrl_add_gpio_range(pctl->pctldev, &soc->gpioranges[n]); in mvebu_pinctrl_probe()
752 * mvebu_pinctrl_simple_mmio_probe - probe a simple mmio pinctrl
760 struct mvebu_pinctrl_soc_info *soc = dev_get_platdata(&pdev->dev); in mvebu_pinctrl_simple_mmio_probe() local
769 mpp_data = devm_kcalloc(&pdev->dev, soc->ncontrols, sizeof(*mpp_data), in mvebu_pinctrl_simple_mmio_probe()
772 return -ENOMEM; in mvebu_pinctrl_simple_mmio_probe()
774 for (i = 0; i < soc->ncontrols; i++) in mvebu_pinctrl_simple_mmio_probe()
777 soc->control_data = mpp_data; in mvebu_pinctrl_simple_mmio_probe()
790 err = regmap_read(data->regmap.map, data->regmap.offset + off, &val); in mvebu_regmap_mpp_ctrl_get()
805 return regmap_update_bits(data->regmap.map, data->regmap.offset + off, in mvebu_regmap_mpp_ctrl_set()
812 struct mvebu_pinctrl_soc_info *soc = dev_get_platdata(&pdev->dev); in mvebu_pinctrl_simple_regmap_probe() local
817 regmap = syscon_node_to_regmap(syscon_dev->of_node); in mvebu_pinctrl_simple_regmap_probe()
821 mpp_data = devm_kcalloc(&pdev->dev, soc->ncontrols, sizeof(*mpp_data), in mvebu_pinctrl_simple_regmap_probe()
824 return -ENOMEM; in mvebu_pinctrl_simple_regmap_probe()
826 for (i = 0; i < soc->ncontrols; i++) { in mvebu_pinctrl_simple_regmap_probe()
831 soc->control_data = mpp_data; in mvebu_pinctrl_simple_regmap_probe()