pinctrl: add explicit gpio_disable_free pinmux_op
Some pinctrl drivers (Tegra at least) program a pin to be a GPIO in a completely different manner than they select which function to mux out of that pin. In order to support a single "free" pinmux_op, the driver would need to maintain a per-pin state of requested-for-gpio vs. requested-for- function. However, that's a lot of work when the core already has explicit separate paths for gpio request/free and function request/free. So, add a gpio_disable_free op to struct pinmux_ops, and make pin_free() call it when appropriate. When doing this, I noticed that when calling pin_request(): !!gpio == (gpio_range != NULL) ... and so I collapsed those two parameters in both pin_request(), and when adding writing the new code in pin_free(). Also, for pin_free(): !!free_func == (gpio_range != NULL) However, I didn't want pin_free() to know about the GPIO function naming special case, so instead, I reworked pin_free() to always return the pin's previously requested function, and now pinmux_free_gpio() calls kfree(function). This is much more balanced with the allocation having been performed in pinmux_request_gpio(). Signed-off-by: Stephen Warren <swarren@nvidia.com> Signed-off-by: Linus Walleij <linus.walleij@linaro.org>
This commit is contained in:
parent
d2f6a1c6fb
commit
3712a3c488
@ -94,12 +94,11 @@ struct pinmux_hog {
|
|||||||
* @function: a functional name to give to this pin, passed to the driver
|
* @function: a functional name to give to this pin, passed to the driver
|
||||||
* so it knows what function to mux in, e.g. the string "gpioNN"
|
* so it knows what function to mux in, e.g. the string "gpioNN"
|
||||||
* means that you want to mux in the pin for use as GPIO number NN
|
* means that you want to mux in the pin for use as GPIO number NN
|
||||||
* @gpio: if this request concerns a single GPIO pin
|
|
||||||
* @gpio_range: the range matching the GPIO pin if this is a request for a
|
* @gpio_range: the range matching the GPIO pin if this is a request for a
|
||||||
* single GPIO pin
|
* single GPIO pin
|
||||||
*/
|
*/
|
||||||
static int pin_request(struct pinctrl_dev *pctldev,
|
static int pin_request(struct pinctrl_dev *pctldev,
|
||||||
int pin, const char *function, bool gpio,
|
int pin, const char *function,
|
||||||
struct pinctrl_gpio_range *gpio_range)
|
struct pinctrl_gpio_range *gpio_range)
|
||||||
{
|
{
|
||||||
struct pin_desc *desc;
|
struct pin_desc *desc;
|
||||||
@ -143,7 +142,7 @@ static int pin_request(struct pinctrl_dev *pctldev,
|
|||||||
* If there is no kind of request function for the pin we just assume
|
* If there is no kind of request function for the pin we just assume
|
||||||
* we got it by default and proceed.
|
* we got it by default and proceed.
|
||||||
*/
|
*/
|
||||||
if (gpio && ops->gpio_request_enable)
|
if (gpio_range && ops->gpio_request_enable)
|
||||||
/* This requests and enables a single GPIO pin */
|
/* This requests and enables a single GPIO pin */
|
||||||
status = ops->gpio_request_enable(pctldev, gpio_range, pin);
|
status = ops->gpio_request_enable(pctldev, gpio_range, pin);
|
||||||
else if (ops->request)
|
else if (ops->request)
|
||||||
@ -173,29 +172,39 @@ out:
|
|||||||
* pin_free() - release a single muxed in pin so something else can be muxed
|
* pin_free() - release a single muxed in pin so something else can be muxed
|
||||||
* @pctldev: pin controller device handling this pin
|
* @pctldev: pin controller device handling this pin
|
||||||
* @pin: the pin to free
|
* @pin: the pin to free
|
||||||
* @free_func: whether to free the pin's assigned function name string
|
* @gpio_range: the range matching the GPIO pin if this is a request for a
|
||||||
|
* single GPIO pin
|
||||||
*/
|
*/
|
||||||
static void pin_free(struct pinctrl_dev *pctldev, int pin, int free_func)
|
static const char *pin_free(struct pinctrl_dev *pctldev, int pin,
|
||||||
|
struct pinctrl_gpio_range *gpio_range)
|
||||||
{
|
{
|
||||||
const struct pinmux_ops *ops = pctldev->desc->pmxops;
|
const struct pinmux_ops *ops = pctldev->desc->pmxops;
|
||||||
struct pin_desc *desc;
|
struct pin_desc *desc;
|
||||||
|
const char *func;
|
||||||
|
|
||||||
desc = pin_desc_get(pctldev, pin);
|
desc = pin_desc_get(pctldev, pin);
|
||||||
if (desc == NULL) {
|
if (desc == NULL) {
|
||||||
dev_err(&pctldev->dev,
|
dev_err(&pctldev->dev,
|
||||||
"pin is not registered so it cannot be freed\n");
|
"pin is not registered so it cannot be freed\n");
|
||||||
return;
|
return NULL;
|
||||||
}
|
}
|
||||||
|
|
||||||
if (ops->free)
|
/*
|
||||||
|
* If there is no kind of request function for the pin we just assume
|
||||||
|
* we got it by default and proceed.
|
||||||
|
*/
|
||||||
|
if (gpio_range && ops->gpio_disable_free)
|
||||||
|
ops->gpio_disable_free(pctldev, gpio_range, pin);
|
||||||
|
else if (ops->free)
|
||||||
ops->free(pctldev, pin);
|
ops->free(pctldev, pin);
|
||||||
|
|
||||||
spin_lock(&desc->lock);
|
spin_lock(&desc->lock);
|
||||||
if (free_func)
|
func = desc->mux_function;
|
||||||
kfree(desc->mux_function);
|
|
||||||
desc->mux_function = NULL;
|
desc->mux_function = NULL;
|
||||||
spin_unlock(&desc->lock);
|
spin_unlock(&desc->lock);
|
||||||
module_put(pctldev->owner);
|
module_put(pctldev->owner);
|
||||||
|
|
||||||
|
return func;
|
||||||
}
|
}
|
||||||
|
|
||||||
/**
|
/**
|
||||||
@ -225,7 +234,7 @@ int pinmux_request_gpio(unsigned gpio)
|
|||||||
if (!function)
|
if (!function)
|
||||||
return -EINVAL;
|
return -EINVAL;
|
||||||
|
|
||||||
ret = pin_request(pctldev, pin, function, true, range);
|
ret = pin_request(pctldev, pin, function, range);
|
||||||
if (ret < 0)
|
if (ret < 0)
|
||||||
kfree(function);
|
kfree(function);
|
||||||
|
|
||||||
@ -243,6 +252,7 @@ void pinmux_free_gpio(unsigned gpio)
|
|||||||
struct pinctrl_gpio_range *range;
|
struct pinctrl_gpio_range *range;
|
||||||
int ret;
|
int ret;
|
||||||
int pin;
|
int pin;
|
||||||
|
const char *func;
|
||||||
|
|
||||||
ret = pinctrl_get_device_gpio_range(gpio, &pctldev, &range);
|
ret = pinctrl_get_device_gpio_range(gpio, &pctldev, &range);
|
||||||
if (ret)
|
if (ret)
|
||||||
@ -251,7 +261,8 @@ void pinmux_free_gpio(unsigned gpio)
|
|||||||
/* Convert to the pin controllers number space */
|
/* Convert to the pin controllers number space */
|
||||||
pin = gpio - range->base;
|
pin = gpio - range->base;
|
||||||
|
|
||||||
pin_free(pctldev, pin, true);
|
func = pin_free(pctldev, pin, range);
|
||||||
|
kfree(func);
|
||||||
}
|
}
|
||||||
EXPORT_SYMBOL_GPL(pinmux_free_gpio);
|
EXPORT_SYMBOL_GPL(pinmux_free_gpio);
|
||||||
|
|
||||||
@ -341,7 +352,7 @@ static int acquire_pins(struct pinctrl_dev *pctldev,
|
|||||||
|
|
||||||
/* Try to allocate all pins in this group, one by one */
|
/* Try to allocate all pins in this group, one by one */
|
||||||
for (i = 0; i < num_pins; i++) {
|
for (i = 0; i < num_pins; i++) {
|
||||||
ret = pin_request(pctldev, pins[i], func, false, NULL);
|
ret = pin_request(pctldev, pins[i], func, NULL);
|
||||||
if (ret) {
|
if (ret) {
|
||||||
dev_err(&pctldev->dev,
|
dev_err(&pctldev->dev,
|
||||||
"could not get pin %d for function %s "
|
"could not get pin %d for function %s "
|
||||||
@ -351,7 +362,7 @@ static int acquire_pins(struct pinctrl_dev *pctldev,
|
|||||||
/* On error release all taken pins */
|
/* On error release all taken pins */
|
||||||
i--; /* this pin just failed */
|
i--; /* this pin just failed */
|
||||||
for (; i >= 0; i--)
|
for (; i >= 0; i--)
|
||||||
pin_free(pctldev, pins[i], false);
|
pin_free(pctldev, pins[i], NULL);
|
||||||
return -ENODEV;
|
return -ENODEV;
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
@ -381,7 +392,7 @@ static void release_pins(struct pinctrl_dev *pctldev,
|
|||||||
return;
|
return;
|
||||||
}
|
}
|
||||||
for (i = 0; i < num_pins; i++)
|
for (i = 0; i < num_pins; i++)
|
||||||
pin_free(pctldev, pins[i], false);
|
pin_free(pctldev, pins[i], NULL);
|
||||||
}
|
}
|
||||||
|
|
||||||
/**
|
/**
|
||||||
|
@ -73,6 +73,9 @@ struct pinmux_ops {
|
|||||||
int (*gpio_request_enable) (struct pinctrl_dev *pctldev,
|
int (*gpio_request_enable) (struct pinctrl_dev *pctldev,
|
||||||
struct pinctrl_gpio_range *range,
|
struct pinctrl_gpio_range *range,
|
||||||
unsigned offset);
|
unsigned offset);
|
||||||
|
void (*gpio_disable_free) (struct pinctrl_dev *pctldev,
|
||||||
|
struct pinctrl_gpio_range *range,
|
||||||
|
unsigned offset);
|
||||||
};
|
};
|
||||||
|
|
||||||
/* External interface to pinmux */
|
/* External interface to pinmux */
|
||||||
|
Loading…
Reference in New Issue
Block a user