linux-imx
Public
Source
committed 504c76979bcx
}static const struct pinctrl_ops axp20x_pctrl_ops = { .dt_node_to_map = pinconf_generic_dt_node_to_map_group, .dt_free_map = pinconf_generic_dt_free_map, .get_groups_count = axp20x_groups_cnt, .get_group_name = axp20x_group_name, .get_group_pins = axp20x_group_pins,};static void axp20x_funcs_groups_from_mask(struct device *dev, unsigned int mask,static int axp20x_funcs_groups_from_mask(struct device *dev, unsigned int mask, unsigned int mask_len, struct axp20x_pinctrl_function *func, const struct pinctrl_pin_desc *pins){ unsigned long int mask_cpy = mask; const char **group; unsigned int ngroups = hweight8(mask); int bit; func->ngroups = ngroups; if (func->ngroups > 0) { func->groups = devm_kcalloc(dev, ngroups, sizeof(const char *), GFP_KERNEL); if (!func->groups) return -ENOMEM; group = func->groups; for_each_set_bit(bit, &mask_cpy, mask_len) { *group = pins[bit].name; group++; } } return 0;}static void axp20x_build_funcs_groups(struct platform_device *pdev)static int axp20x_build_funcs_groups(struct platform_device *pdev){ struct axp20x_pctl *pctl = platform_get_drvdata(pdev); int i, pin, npins = pctl->desc->npins; int i, ret, pin, npins = pctl->desc->npins; pctl->funcs[AXP20X_FUNC_GPIO_OUT].name = "gpio_out"; pctl->funcs[AXP20X_FUNC_GPIO_OUT].muxval = AXP20X_MUX_GPIO_OUT; pctl->funcs[AXP20X_FUNC_GPIO_IN].name = "gpio_in"; pctl->funcs[AXP20X_FUNC_GPIO_IN].muxval = AXP20X_MUX_GPIO_IN; pctl->funcs[AXP20X_FUNC_LDO].name = "ldo"; /* * Muxval for LDO is useless as we won't use it. * See comment in axp20x_pmx_set_mux. */ /* Every pin supports GPIO_OUT and GPIO_IN functions */ for (i = 0; i <= AXP20X_FUNC_GPIO_IN; i++) { pctl->funcs[i].ngroups = npins; pctl->funcs[i].groups = devm_kcalloc(&pdev->dev, npins, sizeof(char *), GFP_KERNEL); for (pin = 0; pin < npins; pin++) pctl->funcs[i].groups[pin] = pctl->desc->pins[pin].name; } axp20x_funcs_groups_from_mask(&pdev->dev, pctl->desc->ldo_mask, ret = axp20x_funcs_groups_from_mask(&pdev->dev, pctl->desc->ldo_mask, npins, &pctl->funcs[AXP20X_FUNC_LDO], pctl->desc->pins); if (ret) return ret; axp20x_funcs_groups_from_mask(&pdev->dev, pctl->desc->adc_mask, ret = axp20x_funcs_groups_from_mask(&pdev->dev, pctl->desc->adc_mask, npins, &pctl->funcs[AXP20X_FUNC_ADC], pctl->desc->pins); if (ret) return ret; return 0;}static const struct of_device_id axp20x_pctl_match[] = { { .compatible = "x-powers,axp209-gpio", .data = &axp20x_data, }, { .compatible = "x-powers,axp813-gpio", .data = &axp813_data, }, { }};MODULE_DEVICE_TABLE(of, axp20x_pctl_match);static int axp20x_pctl_probe(struct platform_device *pdev) pctl->desc = of_device_get_match_data(dev); pctl->chip.ngpio = pctl->desc->npins; pctl->regmap = axp20x->regmap; pctl->dev = &pdev->dev; platform_set_drvdata(pdev, pctl); axp20x_build_funcs_groups(pdev); ret = axp20x_build_funcs_groups(pdev); if (ret) { dev_err(&pdev->dev, "failed to build groups\n"); return ret; } pctrl_desc = devm_kzalloc(&pdev->dev, sizeof(*pctrl_desc), GFP_KERNEL); if (!pctrl_desc) return -ENOMEM; pctrl_desc->name = dev_name(&pdev->dev); pctrl_desc->owner = THIS_MODULE; pctrl_desc->pins = pctl->desc->pins; pctrl_desc->npins = pctl->desc->npins; pctrl_desc->pctlops = &axp20x_pctrl_ops;