diff options
| author | Oleksandr Suvorov <oleksandr.suvorov@toradex.com> | 2019-09-18 15:32:45 +0300 |
|---|---|---|
| committer | Marcel Ziswiler <marcel.ziswiler@toradex.com> | 2020-02-12 11:06:03 +0100 |
| commit | 964f69e00a4d81f9279e61d7b82966c63e7a78ed (patch) | |
| tree | a3a28bb29c63ecda935b7909268aaff95ab065e4 /drivers/power | |
| parent | b43415e2d1ac6ff6ebc39783b8cf3c9911a9cfd5 (diff) | |
power: reset: gpio-poweroff: add force-mode
Property "force-mode" tells the driver to replace previously
initialized power-off kernel hook and allows gpio-poweroff to
probe and operate successfully in any case.
Related-to: #42589
Signed-off-by: Oleksandr Suvorov <oleksandr.suvorov@toradex.com>
Diffstat (limited to 'drivers/power')
| -rw-r--r-- | drivers/power/reset/gpio-poweroff.c | 27 |
1 files changed, 21 insertions, 6 deletions
diff --git a/drivers/power/reset/gpio-poweroff.c b/drivers/power/reset/gpio-poweroff.c index be3d81ff51cc..c96be0fa39bf 100644 --- a/drivers/power/reset/gpio-poweroff.c +++ b/drivers/power/reset/gpio-poweroff.c @@ -24,6 +24,7 @@ * since pm_power_off itself is global. */ static struct gpio_desc *reset_gpio; +static void *prev_pm_power_off = NULL; static void gpio_poweroff_do_poweroff(void) { @@ -48,14 +49,28 @@ static void gpio_poweroff_do_poweroff(void) static int gpio_poweroff_probe(struct platform_device *pdev) { bool input = false; + bool force = false; enum gpiod_flags flags; - /* If a pm_power_off function has already been added, leave it alone */ + + force = of_property_read_bool(pdev->dev.of_node, "force-mode"); + + /* + * If a pm_power_off function has already been added, leave it alone, + * if force-mode is not enabled. + */ if (pm_power_off != NULL) { - dev_err(&pdev->dev, - "%s: pm_power_off function already registered", - __func__); - return -EBUSY; + if (force) { + dev_warn(&pdev->dev, + "%s: pm_power_off function replaced", + __func__); + prev_pm_power_off = pm_power_off; + } else { + dev_err(&pdev->dev, + "%s: pm_power_off function already registered", + __func__); + return -EBUSY; + } } input = of_property_read_bool(pdev->dev.of_node, "input"); @@ -75,7 +90,7 @@ static int gpio_poweroff_probe(struct platform_device *pdev) static int gpio_poweroff_remove(struct platform_device *pdev) { if (pm_power_off == &gpio_poweroff_do_poweroff) - pm_power_off = NULL; + pm_power_off = prev_pm_power_off; return 0; } |