pinctrl: sunxi: Deal with configless pins

Even though the our binding had the assumption that the allwinner,pull and
allwinner,drive properties were optional, the code never took that into
account.

Fix that.

Signed-off-by: Maxime Ripard <maxime.ripard@free-electrons.com>
Acked-by: Chen-Yu Tsai <wens@csie.org>
Signed-off-by: Linus Walleij <linus.walleij@linaro.org>
This commit is contained in:
Maxime Ripard 2016-10-20 15:49:02 +02:00 committed by Linus Walleij
parent b9aa65ba8e
commit e11dee2e98
1 changed files with 37 additions and 14 deletions

View File

@ -261,20 +261,29 @@ static unsigned long *sunxi_pctrl_build_pin_config(struct device_node *node,
{ {
unsigned long *pinconfig; unsigned long *pinconfig;
unsigned int configlen = 0, idx = 0; unsigned int configlen = 0, idx = 0;
int ret;
if (sunxi_pctrl_has_drive_prop(node)) if (sunxi_pctrl_has_drive_prop(node))
configlen++; configlen++;
if (sunxi_pctrl_has_bias_prop(node)) if (sunxi_pctrl_has_bias_prop(node))
configlen++; configlen++;
/*
* If we don't have any configuration, bail out
*/
if (!configlen)
return NULL;
pinconfig = kzalloc(configlen * sizeof(*pinconfig), GFP_KERNEL); pinconfig = kzalloc(configlen * sizeof(*pinconfig), GFP_KERNEL);
if (!pinconfig) if (!pinconfig)
return NULL; return ERR_PTR(-ENOMEM);
if (sunxi_pctrl_has_drive_prop(node)) { if (sunxi_pctrl_has_drive_prop(node)) {
int drive = sunxi_pctrl_parse_drive_prop(node); int drive = sunxi_pctrl_parse_drive_prop(node);
if (drive < 0) if (drive < 0) {
ret = drive;
goto err_free; goto err_free;
}
pinconfig[idx++] = pinconf_to_config_packed(PIN_CONFIG_DRIVE_STRENGTH, pinconfig[idx++] = pinconf_to_config_packed(PIN_CONFIG_DRIVE_STRENGTH,
drive); drive);
@ -282,8 +291,10 @@ static unsigned long *sunxi_pctrl_build_pin_config(struct device_node *node,
if (sunxi_pctrl_has_bias_prop(node)) { if (sunxi_pctrl_has_bias_prop(node)) {
int pull = sunxi_pctrl_parse_bias_prop(node); int pull = sunxi_pctrl_parse_bias_prop(node);
if (pull < 0) if (pull < 0) {
ret = pull;
goto err_free; goto err_free;
}
pinconfig[idx++] = pinconf_to_config_packed(pull, 0); pinconfig[idx++] = pinconf_to_config_packed(pull, 0);
} }
@ -294,7 +305,7 @@ static unsigned long *sunxi_pctrl_build_pin_config(struct device_node *node,
err_free: err_free:
kfree(pinconfig); kfree(pinconfig);
return NULL; return ERR_PTR(ret);
} }
static int sunxi_pctrl_dt_node_to_map(struct pinctrl_dev *pctldev, static int sunxi_pctrl_dt_node_to_map(struct pinctrl_dev *pctldev,
@ -328,7 +339,10 @@ static int sunxi_pctrl_dt_node_to_map(struct pinctrl_dev *pctldev,
/* /*
* We have two maps for each pin: one for the function, one * We have two maps for each pin: one for the function, one
* for the configuration (bias, strength, etc) * for the configuration (bias, strength, etc).
*
* We might be slightly overshooting, since we might not have
* any configuration.
*/ */
nmaps = npins * 2; nmaps = npins * 2;
*map = kmalloc(nmaps * sizeof(struct pinctrl_map), GFP_KERNEL); *map = kmalloc(nmaps * sizeof(struct pinctrl_map), GFP_KERNEL);
@ -336,8 +350,8 @@ static int sunxi_pctrl_dt_node_to_map(struct pinctrl_dev *pctldev,
return -ENOMEM; return -ENOMEM;
pinconfig = sunxi_pctrl_build_pin_config(node, &configlen); pinconfig = sunxi_pctrl_build_pin_config(node, &configlen);
if (!pinconfig) { if (IS_ERR(pinconfig)) {
ret = -EINVAL; ret = PTR_ERR(pinconfig);
goto err_free_map; goto err_free_map;
} }
@ -364,15 +378,24 @@ static int sunxi_pctrl_dt_node_to_map(struct pinctrl_dev *pctldev,
i++; i++;
if (pinconfig) {
(*map)[i].type = PIN_MAP_TYPE_CONFIGS_GROUP; (*map)[i].type = PIN_MAP_TYPE_CONFIGS_GROUP;
(*map)[i].data.configs.group_or_pin = group; (*map)[i].data.configs.group_or_pin = group;
(*map)[i].data.configs.configs = pinconfig; (*map)[i].data.configs.configs = pinconfig;
(*map)[i].data.configs.num_configs = configlen; (*map)[i].data.configs.num_configs = configlen;
i++; i++;
} }
}
*num_maps = nmaps; *num_maps = i;
/*
* We know have the number of maps we need, we can resize our
* map array
*/
*map = krealloc(*map, i * sizeof(struct pinctrl_map), GFP_KERNEL);
if (!map)
return -ENOMEM;
return 0; return 0;