forked from Minki/linux
staging: mt7621-pinctrl: refactor rt2880_pinctrl_dt_node_to_map function
Using 'function' and 'group' bindings in the device tree give the posibility of refactor 'rt2880_pinctrl_dt_node_to_map' and simplify it a lot. Make use of 'for_each_node_with_property' function to count number of groups for the node and iterate over the groups using 'of_property_for_each_string' calling 'pinctrl_utils_add_map_mux' function which is the same of the custom function in this driver code 'rt2880_pinctrl_dt_subnode_to_map' which is not needed anymore. Signed-off-by: Sergio Paracuellos <sergio.paracuellos@gmail.com> Signed-off-by: Greg Kroah-Hartman <gregkh@linuxfoundation.org>
This commit is contained in:
parent
d7461eab5a
commit
e12a1a6e08
@ -83,65 +83,37 @@ static void rt2880_pinctrl_pin_dbg_show(struct pinctrl_dev *pctrldev,
|
||||
seq_puts(s, "ralink pio");
|
||||
}
|
||||
|
||||
static void rt2880_pinctrl_dt_subnode_to_map(struct pinctrl_dev *pctrldev,
|
||||
struct device_node *np,
|
||||
struct pinctrl_map **map)
|
||||
{
|
||||
const char *function;
|
||||
int func = of_property_read_string(np, "ralink,function", &function);
|
||||
int grps = of_property_count_strings(np, "ralink,group");
|
||||
int i;
|
||||
|
||||
if (func || !grps)
|
||||
return;
|
||||
|
||||
for (i = 0; i < grps; i++) {
|
||||
const char *group;
|
||||
|
||||
of_property_read_string_index(np, "ralink,group", i, &group);
|
||||
|
||||
(*map)->type = PIN_MAP_TYPE_MUX_GROUP;
|
||||
(*map)->name = function;
|
||||
(*map)->data.mux.group = group;
|
||||
(*map)->data.mux.function = function;
|
||||
(*map)++;
|
||||
}
|
||||
}
|
||||
|
||||
static int rt2880_pinctrl_dt_node_to_map(struct pinctrl_dev *pctrldev,
|
||||
struct device_node *np_config,
|
||||
struct pinctrl_map **map,
|
||||
unsigned int *num_maps)
|
||||
{
|
||||
struct rt2880_priv *p = pinctrl_dev_get_drvdata(pctrldev);
|
||||
struct property *prop;
|
||||
const char *function_name, *group_name;
|
||||
int ret;
|
||||
int max_maps = 0;
|
||||
int ngroups;
|
||||
unsigned int reserved_maps = 0;
|
||||
struct pinctrl_map *tmp;
|
||||
struct device_node *np;
|
||||
|
||||
for_each_child_of_node(np_config, np) {
|
||||
int ret = of_property_count_strings(np, "ralink,group");
|
||||
|
||||
if (ret >= 0)
|
||||
max_maps += ret;
|
||||
}
|
||||
|
||||
if (!max_maps)
|
||||
return max_maps;
|
||||
for_each_node_with_property(np_config, "group")
|
||||
ngroups++;
|
||||
|
||||
ret = pinctrl_utils_reserve_map(pctrldev, map, &reserved_maps,
|
||||
num_maps, max_maps);
|
||||
num_maps, ngroups);
|
||||
if (ret) {
|
||||
dev_err(p->dev, "can't reserve map: %d\n", ret);
|
||||
return ret;
|
||||
}
|
||||
|
||||
tmp = *map;
|
||||
|
||||
for_each_child_of_node(np_config, np)
|
||||
rt2880_pinctrl_dt_subnode_to_map(pctrldev, np, &tmp);
|
||||
*num_maps = max_maps;
|
||||
of_property_for_each_string(np_config, "group", prop, group_name) {
|
||||
ret = pinctrl_utils_add_map_mux(pctrldev, map, &reserved_maps,
|
||||
num_maps, group_name,
|
||||
function_name);
|
||||
if (ret) {
|
||||
dev_err(p->dev, "can't add map: %d\n", ret);
|
||||
return ret;
|
||||
}
|
||||
}
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
Loading…
Reference in New Issue
Block a user