13f8c50c9SJohn Crispin /* 23f8c50c9SJohn Crispin * linux/drivers/pinctrl/pinctrl-lantiq.c 33f8c50c9SJohn Crispin * based on linux/drivers/pinctrl/pinctrl-pxa3xx.c 43f8c50c9SJohn Crispin * 53f8c50c9SJohn Crispin * This program is free software; you can redistribute it and/or modify 63f8c50c9SJohn Crispin * it under the terms of the GNU General Public License version 2 as 73f8c50c9SJohn Crispin * publishhed by the Free Software Foundation. 83f8c50c9SJohn Crispin * 93f8c50c9SJohn Crispin * Copyright (C) 2012 John Crispin <blogic@openwrt.org> 103f8c50c9SJohn Crispin */ 113f8c50c9SJohn Crispin 123f8c50c9SJohn Crispin #include <linux/module.h> 133f8c50c9SJohn Crispin #include <linux/device.h> 143f8c50c9SJohn Crispin #include <linux/io.h> 153f8c50c9SJohn Crispin #include <linux/platform_device.h> 163f8c50c9SJohn Crispin #include <linux/slab.h> 173f8c50c9SJohn Crispin #include <linux/of.h> 183f8c50c9SJohn Crispin 193f8c50c9SJohn Crispin #include "pinctrl-lantiq.h" 203f8c50c9SJohn Crispin 213f8c50c9SJohn Crispin static int ltq_get_group_count(struct pinctrl_dev *pctrldev) 223f8c50c9SJohn Crispin { 233f8c50c9SJohn Crispin struct ltq_pinmux_info *info = pinctrl_dev_get_drvdata(pctrldev); 243f8c50c9SJohn Crispin return info->num_grps; 253f8c50c9SJohn Crispin } 263f8c50c9SJohn Crispin 273f8c50c9SJohn Crispin static const char *ltq_get_group_name(struct pinctrl_dev *pctrldev, 283f8c50c9SJohn Crispin unsigned selector) 293f8c50c9SJohn Crispin { 303f8c50c9SJohn Crispin struct ltq_pinmux_info *info = pinctrl_dev_get_drvdata(pctrldev); 313f8c50c9SJohn Crispin if (selector >= info->num_grps) 323f8c50c9SJohn Crispin return NULL; 333f8c50c9SJohn Crispin return info->grps[selector].name; 343f8c50c9SJohn Crispin } 353f8c50c9SJohn Crispin 363f8c50c9SJohn Crispin static int ltq_get_group_pins(struct pinctrl_dev *pctrldev, 373f8c50c9SJohn Crispin unsigned selector, 383f8c50c9SJohn Crispin const unsigned **pins, 393f8c50c9SJohn Crispin unsigned *num_pins) 403f8c50c9SJohn Crispin { 413f8c50c9SJohn Crispin struct ltq_pinmux_info *info = pinctrl_dev_get_drvdata(pctrldev); 423f8c50c9SJohn Crispin if (selector >= info->num_grps) 433f8c50c9SJohn Crispin return -EINVAL; 443f8c50c9SJohn Crispin *pins = info->grps[selector].pins; 453f8c50c9SJohn Crispin *num_pins = info->grps[selector].npins; 463f8c50c9SJohn Crispin return 0; 473f8c50c9SJohn Crispin } 483f8c50c9SJohn Crispin 4989377aa5SAxel Lin static void ltq_pinctrl_dt_free_map(struct pinctrl_dev *pctldev, 503f8c50c9SJohn Crispin struct pinctrl_map *map, unsigned num_maps) 513f8c50c9SJohn Crispin { 523f8c50c9SJohn Crispin int i; 533f8c50c9SJohn Crispin 543f8c50c9SJohn Crispin for (i = 0; i < num_maps; i++) 553f8c50c9SJohn Crispin if (map[i].type == PIN_MAP_TYPE_CONFIGS_PIN) 563f8c50c9SJohn Crispin kfree(map[i].data.configs.configs); 573f8c50c9SJohn Crispin kfree(map); 583f8c50c9SJohn Crispin } 593f8c50c9SJohn Crispin 603f8c50c9SJohn Crispin static void ltq_pinctrl_pin_dbg_show(struct pinctrl_dev *pctldev, 613f8c50c9SJohn Crispin struct seq_file *s, 623f8c50c9SJohn Crispin unsigned offset) 633f8c50c9SJohn Crispin { 643f8c50c9SJohn Crispin seq_printf(s, " %s", dev_name(pctldev->dev)); 653f8c50c9SJohn Crispin } 663f8c50c9SJohn Crispin 673a6b04caSJohn Crispin static void ltq_pinctrl_dt_subnode_to_map(struct pinctrl_dev *pctldev, 683f8c50c9SJohn Crispin struct device_node *np, 693f8c50c9SJohn Crispin struct pinctrl_map **map) 703f8c50c9SJohn Crispin { 713f8c50c9SJohn Crispin struct ltq_pinmux_info *info = pinctrl_dev_get_drvdata(pctldev); 723a6b04caSJohn Crispin struct property *pins = of_find_property(np, "lantiq,pins", NULL); 733a6b04caSJohn Crispin struct property *groups = of_find_property(np, "lantiq,groups", NULL); 743f8c50c9SJohn Crispin unsigned long configs[3]; 753f8c50c9SJohn Crispin unsigned num_configs = 0; 763f8c50c9SJohn Crispin struct property *prop; 773f8c50c9SJohn Crispin const char *group, *pin; 783f8c50c9SJohn Crispin const char *function; 793f8c50c9SJohn Crispin int ret, i; 803f8c50c9SJohn Crispin 813a6b04caSJohn Crispin if (!pins && !groups) { 823a6b04caSJohn Crispin dev_err(pctldev->dev, "%s defines neither pins nor groups\n", 833a6b04caSJohn Crispin np->name); 843a6b04caSJohn Crispin return; 853a6b04caSJohn Crispin } 863a6b04caSJohn Crispin 873a6b04caSJohn Crispin if (pins && groups) { 883a6b04caSJohn Crispin dev_err(pctldev->dev, "%s defines both pins and groups\n", 893a6b04caSJohn Crispin np->name); 903a6b04caSJohn Crispin return; 913a6b04caSJohn Crispin } 923a6b04caSJohn Crispin 933f8c50c9SJohn Crispin ret = of_property_read_string(np, "lantiq,function", &function); 943a6b04caSJohn Crispin if (groups && !ret) { 953f8c50c9SJohn Crispin of_property_for_each_string(np, "lantiq,groups", prop, group) { 963f8c50c9SJohn Crispin (*map)->type = PIN_MAP_TYPE_MUX_GROUP; 973f8c50c9SJohn Crispin (*map)->name = function; 983f8c50c9SJohn Crispin (*map)->data.mux.group = group; 993f8c50c9SJohn Crispin (*map)->data.mux.function = function; 1003f8c50c9SJohn Crispin (*map)++; 1013f8c50c9SJohn Crispin } 1023f8c50c9SJohn Crispin } 1033f8c50c9SJohn Crispin 1043f8c50c9SJohn Crispin for (i = 0; i < info->num_params; i++) { 1053f8c50c9SJohn Crispin u32 val; 1063f8c50c9SJohn Crispin int ret = of_property_read_u32(np, 1073f8c50c9SJohn Crispin info->params[i].property, &val); 1083f8c50c9SJohn Crispin if (!ret) 1093f8c50c9SJohn Crispin configs[num_configs++] = 1103f8c50c9SJohn Crispin LTQ_PINCONF_PACK(info->params[i].param, 1113f8c50c9SJohn Crispin val); 1123f8c50c9SJohn Crispin } 1133f8c50c9SJohn Crispin 1143f8c50c9SJohn Crispin if (!num_configs) 1153a6b04caSJohn Crispin return; 1163f8c50c9SJohn Crispin 1173f8c50c9SJohn Crispin of_property_for_each_string(np, "lantiq,pins", prop, pin) { 1183f8c50c9SJohn Crispin (*map)->data.configs.configs = kmemdup(configs, 1193f8c50c9SJohn Crispin num_configs * sizeof(unsigned long), 1203f8c50c9SJohn Crispin GFP_KERNEL); 1213f8c50c9SJohn Crispin (*map)->type = PIN_MAP_TYPE_CONFIGS_PIN; 1223f8c50c9SJohn Crispin (*map)->name = pin; 1233f8c50c9SJohn Crispin (*map)->data.configs.group_or_pin = pin; 1243f8c50c9SJohn Crispin (*map)->data.configs.num_configs = num_configs; 1253f8c50c9SJohn Crispin (*map)++; 1263f8c50c9SJohn Crispin } 1273a6b04caSJohn Crispin of_property_for_each_string(np, "lantiq,groups", prop, group) { 1283a6b04caSJohn Crispin (*map)->data.configs.configs = kmemdup(configs, 1293a6b04caSJohn Crispin num_configs * sizeof(unsigned long), 1303a6b04caSJohn Crispin GFP_KERNEL); 1313a6b04caSJohn Crispin (*map)->type = PIN_MAP_TYPE_CONFIGS_GROUP; 1323a6b04caSJohn Crispin (*map)->name = group; 1333a6b04caSJohn Crispin (*map)->data.configs.group_or_pin = group; 1343a6b04caSJohn Crispin (*map)->data.configs.num_configs = num_configs; 1353a6b04caSJohn Crispin (*map)++; 1363a6b04caSJohn Crispin } 1373f8c50c9SJohn Crispin } 1383f8c50c9SJohn Crispin 1393f8c50c9SJohn Crispin static int ltq_pinctrl_dt_subnode_size(struct device_node *np) 1403f8c50c9SJohn Crispin { 1413f8c50c9SJohn Crispin int ret; 1423f8c50c9SJohn Crispin 1433f8c50c9SJohn Crispin ret = of_property_count_strings(np, "lantiq,groups"); 1443f8c50c9SJohn Crispin if (ret < 0) 1453f8c50c9SJohn Crispin ret = of_property_count_strings(np, "lantiq,pins"); 1463f8c50c9SJohn Crispin return ret; 1473f8c50c9SJohn Crispin } 1483f8c50c9SJohn Crispin 14989377aa5SAxel Lin static int ltq_pinctrl_dt_node_to_map(struct pinctrl_dev *pctldev, 1503f8c50c9SJohn Crispin struct device_node *np_config, 1513f8c50c9SJohn Crispin struct pinctrl_map **map, 1523f8c50c9SJohn Crispin unsigned *num_maps) 1533f8c50c9SJohn Crispin { 1543f8c50c9SJohn Crispin struct pinctrl_map *tmp; 1553f8c50c9SJohn Crispin struct device_node *np; 1563a6b04caSJohn Crispin int max_maps = 0; 1573f8c50c9SJohn Crispin 1583f8c50c9SJohn Crispin for_each_child_of_node(np_config, np) 1593a6b04caSJohn Crispin max_maps += ltq_pinctrl_dt_subnode_size(np); 1603a6b04caSJohn Crispin *map = kzalloc(max_maps * sizeof(struct pinctrl_map) * 2, GFP_KERNEL); 1613f8c50c9SJohn Crispin if (!*map) 1623f8c50c9SJohn Crispin return -ENOMEM; 1633f8c50c9SJohn Crispin tmp = *map; 1643f8c50c9SJohn Crispin 1653a6b04caSJohn Crispin for_each_child_of_node(np_config, np) 1663a6b04caSJohn Crispin ltq_pinctrl_dt_subnode_to_map(pctldev, np, &tmp); 1673a6b04caSJohn Crispin *num_maps = ((int)(tmp - *map)); 1683a6b04caSJohn Crispin 1693f8c50c9SJohn Crispin return 0; 1703f8c50c9SJohn Crispin } 1713f8c50c9SJohn Crispin 1723f8c50c9SJohn Crispin static struct pinctrl_ops ltq_pctrl_ops = { 1733f8c50c9SJohn Crispin .get_groups_count = ltq_get_group_count, 1743f8c50c9SJohn Crispin .get_group_name = ltq_get_group_name, 1753f8c50c9SJohn Crispin .get_group_pins = ltq_get_group_pins, 1763f8c50c9SJohn Crispin .pin_dbg_show = ltq_pinctrl_pin_dbg_show, 1773f8c50c9SJohn Crispin .dt_node_to_map = ltq_pinctrl_dt_node_to_map, 1783f8c50c9SJohn Crispin .dt_free_map = ltq_pinctrl_dt_free_map, 1793f8c50c9SJohn Crispin }; 1803f8c50c9SJohn Crispin 1813f8c50c9SJohn Crispin static int ltq_pmx_func_count(struct pinctrl_dev *pctrldev) 1823f8c50c9SJohn Crispin { 1833f8c50c9SJohn Crispin struct ltq_pinmux_info *info = pinctrl_dev_get_drvdata(pctrldev); 1843f8c50c9SJohn Crispin 1853f8c50c9SJohn Crispin return info->num_funcs; 1863f8c50c9SJohn Crispin } 1873f8c50c9SJohn Crispin 1883f8c50c9SJohn Crispin static const char *ltq_pmx_func_name(struct pinctrl_dev *pctrldev, 1893f8c50c9SJohn Crispin unsigned selector) 1903f8c50c9SJohn Crispin { 1913f8c50c9SJohn Crispin struct ltq_pinmux_info *info = pinctrl_dev_get_drvdata(pctrldev); 1923f8c50c9SJohn Crispin 1933f8c50c9SJohn Crispin if (selector >= info->num_funcs) 1943f8c50c9SJohn Crispin return NULL; 1953f8c50c9SJohn Crispin 1963f8c50c9SJohn Crispin return info->funcs[selector].name; 1973f8c50c9SJohn Crispin } 1983f8c50c9SJohn Crispin 1993f8c50c9SJohn Crispin static int ltq_pmx_get_groups(struct pinctrl_dev *pctrldev, 2003f8c50c9SJohn Crispin unsigned func, 2013f8c50c9SJohn Crispin const char * const **groups, 2023f8c50c9SJohn Crispin unsigned * const num_groups) 2033f8c50c9SJohn Crispin { 2043f8c50c9SJohn Crispin struct ltq_pinmux_info *info = pinctrl_dev_get_drvdata(pctrldev); 2053f8c50c9SJohn Crispin 2063f8c50c9SJohn Crispin *groups = info->funcs[func].groups; 2073f8c50c9SJohn Crispin *num_groups = info->funcs[func].num_groups; 2083f8c50c9SJohn Crispin 2093f8c50c9SJohn Crispin return 0; 2103f8c50c9SJohn Crispin } 2113f8c50c9SJohn Crispin 2123f8c50c9SJohn Crispin /* Return function number. If failure, return negative value. */ 2133f8c50c9SJohn Crispin static int match_mux(const struct ltq_mfp_pin *mfp, unsigned mux) 2143f8c50c9SJohn Crispin { 2153f8c50c9SJohn Crispin int i; 2163f8c50c9SJohn Crispin for (i = 0; i < LTQ_MAX_MUX; i++) { 2173f8c50c9SJohn Crispin if (mfp->func[i] == mux) 2183f8c50c9SJohn Crispin break; 2193f8c50c9SJohn Crispin } 2203f8c50c9SJohn Crispin if (i >= LTQ_MAX_MUX) 2213f8c50c9SJohn Crispin return -EINVAL; 2223f8c50c9SJohn Crispin return i; 2233f8c50c9SJohn Crispin } 2243f8c50c9SJohn Crispin 2253f8c50c9SJohn Crispin /* dont assume .mfp is linearly mapped. find the mfp with the correct .pin */ 2263f8c50c9SJohn Crispin static int match_mfp(const struct ltq_pinmux_info *info, int pin) 2273f8c50c9SJohn Crispin { 2283f8c50c9SJohn Crispin int i; 2293f8c50c9SJohn Crispin for (i = 0; i < info->num_mfp; i++) { 2303f8c50c9SJohn Crispin if (info->mfp[i].pin == pin) 2313f8c50c9SJohn Crispin return i; 2323f8c50c9SJohn Crispin } 2333f8c50c9SJohn Crispin return -1; 2343f8c50c9SJohn Crispin } 2353f8c50c9SJohn Crispin 2363f8c50c9SJohn Crispin /* check whether current pin configuration is valid. Negative for failure */ 2373f8c50c9SJohn Crispin static int match_group_mux(const struct ltq_pin_group *grp, 2383f8c50c9SJohn Crispin const struct ltq_pinmux_info *info, 2393f8c50c9SJohn Crispin unsigned mux) 2403f8c50c9SJohn Crispin { 2413f8c50c9SJohn Crispin int i, pin, ret = 0; 2423f8c50c9SJohn Crispin for (i = 0; i < grp->npins; i++) { 2433f8c50c9SJohn Crispin pin = match_mfp(info, grp->pins[i]); 2443f8c50c9SJohn Crispin if (pin < 0) { 2453f8c50c9SJohn Crispin dev_err(info->dev, "could not find mfp for pin %d\n", 2463f8c50c9SJohn Crispin grp->pins[i]); 2473f8c50c9SJohn Crispin return -EINVAL; 2483f8c50c9SJohn Crispin } 2493f8c50c9SJohn Crispin ret = match_mux(&info->mfp[pin], mux); 2503f8c50c9SJohn Crispin if (ret < 0) { 2513f8c50c9SJohn Crispin dev_err(info->dev, "Can't find mux %d on pin%d\n", 2523f8c50c9SJohn Crispin mux, pin); 2533f8c50c9SJohn Crispin break; 2543f8c50c9SJohn Crispin } 2553f8c50c9SJohn Crispin } 2563f8c50c9SJohn Crispin return ret; 2573f8c50c9SJohn Crispin } 2583f8c50c9SJohn Crispin 2593f8c50c9SJohn Crispin static int ltq_pmx_enable(struct pinctrl_dev *pctrldev, 2603f8c50c9SJohn Crispin unsigned func, 2613f8c50c9SJohn Crispin unsigned group) 2623f8c50c9SJohn Crispin { 2633f8c50c9SJohn Crispin struct ltq_pinmux_info *info = pinctrl_dev_get_drvdata(pctrldev); 2643f8c50c9SJohn Crispin const struct ltq_pin_group *pin_grp = &info->grps[group]; 2653f8c50c9SJohn Crispin int i, pin, pin_func, ret; 2663f8c50c9SJohn Crispin 2673f8c50c9SJohn Crispin if (!pin_grp->npins || 2683f8c50c9SJohn Crispin (match_group_mux(pin_grp, info, pin_grp->mux) < 0)) { 2693f8c50c9SJohn Crispin dev_err(info->dev, "Failed to set the pin group: %s\n", 2703f8c50c9SJohn Crispin info->grps[group].name); 2713f8c50c9SJohn Crispin return -EINVAL; 2723f8c50c9SJohn Crispin } 2733f8c50c9SJohn Crispin for (i = 0; i < pin_grp->npins; i++) { 2743f8c50c9SJohn Crispin pin = match_mfp(info, pin_grp->pins[i]); 2753f8c50c9SJohn Crispin if (pin < 0) { 2763f8c50c9SJohn Crispin dev_err(info->dev, "could not find mfp for pin %d\n", 2773f8c50c9SJohn Crispin pin_grp->pins[i]); 2783f8c50c9SJohn Crispin return -EINVAL; 2793f8c50c9SJohn Crispin } 2803f8c50c9SJohn Crispin pin_func = match_mux(&info->mfp[pin], pin_grp->mux); 2813f8c50c9SJohn Crispin ret = info->apply_mux(pctrldev, pin, pin_func); 2823f8c50c9SJohn Crispin if (ret) { 2833f8c50c9SJohn Crispin dev_err(info->dev, 2843f8c50c9SJohn Crispin "failed to apply mux %d for pin %d\n", 2853f8c50c9SJohn Crispin pin_func, pin); 2863f8c50c9SJohn Crispin return ret; 2873f8c50c9SJohn Crispin } 2883f8c50c9SJohn Crispin } 2893f8c50c9SJohn Crispin return 0; 2903f8c50c9SJohn Crispin } 2913f8c50c9SJohn Crispin 2923f8c50c9SJohn Crispin static int ltq_pmx_gpio_request_enable(struct pinctrl_dev *pctrldev, 2933f8c50c9SJohn Crispin struct pinctrl_gpio_range *range, 2943f8c50c9SJohn Crispin unsigned pin) 2953f8c50c9SJohn Crispin { 2963f8c50c9SJohn Crispin struct ltq_pinmux_info *info = pinctrl_dev_get_drvdata(pctrldev); 297d8a7c1f1SJohn Crispin int mfp = match_mfp(info, pin); 2983f8c50c9SJohn Crispin int pin_func; 2993f8c50c9SJohn Crispin 3003f8c50c9SJohn Crispin if (mfp < 0) { 3013f8c50c9SJohn Crispin dev_err(info->dev, "could not find mfp for pin %d\n", pin); 3023f8c50c9SJohn Crispin return -EINVAL; 3033f8c50c9SJohn Crispin } 3043f8c50c9SJohn Crispin 3053f8c50c9SJohn Crispin pin_func = match_mux(&info->mfp[mfp], 0); 3063f8c50c9SJohn Crispin if (pin_func < 0) { 3073f8c50c9SJohn Crispin dev_err(info->dev, "No GPIO function on pin%d\n", mfp); 3083f8c50c9SJohn Crispin return -EINVAL; 3093f8c50c9SJohn Crispin } 3103f8c50c9SJohn Crispin 3113f8c50c9SJohn Crispin return info->apply_mux(pctrldev, mfp, pin_func); 3123f8c50c9SJohn Crispin } 3133f8c50c9SJohn Crispin 3143f8c50c9SJohn Crispin static struct pinmux_ops ltq_pmx_ops = { 3153f8c50c9SJohn Crispin .get_functions_count = ltq_pmx_func_count, 3163f8c50c9SJohn Crispin .get_function_name = ltq_pmx_func_name, 3173f8c50c9SJohn Crispin .get_function_groups = ltq_pmx_get_groups, 3183f8c50c9SJohn Crispin .enable = ltq_pmx_enable, 3193f8c50c9SJohn Crispin .gpio_request_enable = ltq_pmx_gpio_request_enable, 3203f8c50c9SJohn Crispin }; 3213f8c50c9SJohn Crispin 3223f8c50c9SJohn Crispin /* 3233f8c50c9SJohn Crispin * allow different socs to register with the generic part of the lanti 3243f8c50c9SJohn Crispin * pinctrl code 3253f8c50c9SJohn Crispin */ 3263f8c50c9SJohn Crispin int ltq_pinctrl_register(struct platform_device *pdev, 3273f8c50c9SJohn Crispin struct ltq_pinmux_info *info) 3283f8c50c9SJohn Crispin { 3293f8c50c9SJohn Crispin struct pinctrl_desc *desc; 3303f8c50c9SJohn Crispin 3313f8c50c9SJohn Crispin if (!info) 3323f8c50c9SJohn Crispin return -EINVAL; 3333f8c50c9SJohn Crispin desc = info->desc; 3343f8c50c9SJohn Crispin desc->pctlops = <q_pctrl_ops; 3353f8c50c9SJohn Crispin desc->pmxops = <q_pmx_ops; 3363f8c50c9SJohn Crispin info->dev = &pdev->dev; 3373f8c50c9SJohn Crispin 3383f8c50c9SJohn Crispin info->pctrl = pinctrl_register(desc, &pdev->dev, info); 3393f8c50c9SJohn Crispin if (!info->pctrl) { 3403f8c50c9SJohn Crispin dev_err(&pdev->dev, "failed to register LTQ pinmux driver\n"); 3413f8c50c9SJohn Crispin return -EINVAL; 3423f8c50c9SJohn Crispin } 3433f8c50c9SJohn Crispin platform_set_drvdata(pdev, info); 3443f8c50c9SJohn Crispin return 0; 3453f8c50c9SJohn Crispin } 346