Skip to content

Commit

Permalink
power: reset: gpio-restart: Use devm_register_sys_off_handler()
Browse files Browse the repository at this point in the history
Use device life-cycle managed register function to simplify probe error
path and eliminate need for explicit remove function.

Signed-off-by: Andrew Davis <afd@ti.com>
Signed-off-by: Sebastian Reichel <sebastian.reichel@collabora.com>
  • Loading branch information
Andrew Davis authored and Sebastian Reichel committed Dec 24, 2023
1 parent b55d073 commit c04c4eb
Showing 1 changed file with 9 additions and 25 deletions.
34 changes: 9 additions & 25 deletions drivers/power/reset/gpio-restart.c
Original file line number Diff line number Diff line change
Expand Up @@ -17,17 +17,14 @@

struct gpio_restart {
struct gpio_desc *reset_gpio;
struct notifier_block restart_handler;
u32 active_delay_ms;
u32 inactive_delay_ms;
u32 wait_delay_ms;
};

static int gpio_restart_notify(struct notifier_block *this,
unsigned long mode, void *cmd)
static int gpio_restart_notify(struct sys_off_data *data)
{
struct gpio_restart *gpio_restart =
container_of(this, struct gpio_restart, restart_handler);
struct gpio_restart *gpio_restart = data->cb_data;

/* drive it active, also inactive->active edge */
gpiod_direction_output(gpio_restart->reset_gpio, 1);
Expand All @@ -52,6 +49,7 @@ static int gpio_restart_probe(struct platform_device *pdev)
{
struct gpio_restart *gpio_restart;
bool open_source = false;
int priority = 129;
u32 property;
int ret;

Expand All @@ -71,8 +69,6 @@ static int gpio_restart_probe(struct platform_device *pdev)
return ret;
}

gpio_restart->restart_handler.notifier_call = gpio_restart_notify;
gpio_restart->restart_handler.priority = 129;
gpio_restart->active_delay_ms = 100;
gpio_restart->inactive_delay_ms = 100;
gpio_restart->wait_delay_ms = 3000;
Expand All @@ -83,7 +79,7 @@ static int gpio_restart_probe(struct platform_device *pdev)
dev_err(&pdev->dev, "Invalid priority property: %u\n",
property);
else
gpio_restart->restart_handler.priority = property;
priority = property;
}

of_property_read_u32(pdev->dev.of_node, "active-delay",
Expand All @@ -93,9 +89,11 @@ static int gpio_restart_probe(struct platform_device *pdev)
of_property_read_u32(pdev->dev.of_node, "wait-delay",
&gpio_restart->wait_delay_ms);

platform_set_drvdata(pdev, gpio_restart);

ret = register_restart_handler(&gpio_restart->restart_handler);
ret = devm_register_sys_off_handler(&pdev->dev,
SYS_OFF_MODE_RESTART,
priority,
gpio_restart_notify,
gpio_restart);
if (ret) {
dev_err(&pdev->dev, "%s: cannot register restart handler, %d\n",
__func__, ret);
Expand All @@ -105,27 +103,13 @@ static int gpio_restart_probe(struct platform_device *pdev)
return 0;
}

static void gpio_restart_remove(struct platform_device *pdev)
{
struct gpio_restart *gpio_restart = platform_get_drvdata(pdev);
int ret;

ret = unregister_restart_handler(&gpio_restart->restart_handler);
if (ret) {
dev_err(&pdev->dev,
"%s: cannot unregister restart handler, %d\n",
__func__, ret);
}
}

static const struct of_device_id of_gpio_restart_match[] = {
{ .compatible = "gpio-restart", },
{},
};

static struct platform_driver gpio_restart_driver = {
.probe = gpio_restart_probe,
.remove_new = gpio_restart_remove,
.driver = {
.name = "restart-gpio",
.of_match_table = of_gpio_restart_match,
Expand Down

0 comments on commit c04c4eb

Please sign in to comment.