watchdog: da9063: Add restart handler support
Register a restart handler for the da9063 watchdog. System restart is triggered by sending the shutdown command to the PMIC. As more-suitable restart handlers may exist, the priority of the watchdog restart handler is set to 128. The actual restart method was inspired by a platform-specific patch from the BSP by Hisashi Nakamura <hisashi.nakamura.ak@renesas.com>. Signed-off-by: Geert Uytterhoeven <geert+renesas@glider.be> Acked-by: Steve Twiss <stwiss.opensource@diasemi.com> Reviewed-by: Guenter Roeck <linux@roeck-us.net> Signed-off-by: Wim Van Sebroeck <wim@iguana.be>
This commit is contained in:
parent
9a4c880164
commit
396f163ceb
@ -20,6 +20,7 @@
|
|||||||
#include <linux/delay.h>
|
#include <linux/delay.h>
|
||||||
#include <linux/mfd/da9063/registers.h>
|
#include <linux/mfd/da9063/registers.h>
|
||||||
#include <linux/mfd/da9063/core.h>
|
#include <linux/mfd/da9063/core.h>
|
||||||
|
#include <linux/reboot.h>
|
||||||
#include <linux/regmap.h>
|
#include <linux/regmap.h>
|
||||||
|
|
||||||
/*
|
/*
|
||||||
@ -38,6 +39,7 @@ static const unsigned int wdt_timeout[] = { 0, 2, 4, 8, 16, 32, 65, 131 };
|
|||||||
struct da9063_watchdog {
|
struct da9063_watchdog {
|
||||||
struct da9063 *da9063;
|
struct da9063 *da9063;
|
||||||
struct watchdog_device wdtdev;
|
struct watchdog_device wdtdev;
|
||||||
|
struct notifier_block restart_handler;
|
||||||
};
|
};
|
||||||
|
|
||||||
static unsigned int da9063_wdt_timeout_to_sel(unsigned int secs)
|
static unsigned int da9063_wdt_timeout_to_sel(unsigned int secs)
|
||||||
@ -119,6 +121,23 @@ static int da9063_wdt_set_timeout(struct watchdog_device *wdd,
|
|||||||
return ret;
|
return ret;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
static int da9063_wdt_restart_handler(struct notifier_block *this,
|
||||||
|
unsigned long mode, void *cmd)
|
||||||
|
{
|
||||||
|
struct da9063_watchdog *wdt = container_of(this,
|
||||||
|
struct da9063_watchdog,
|
||||||
|
restart_handler);
|
||||||
|
int ret;
|
||||||
|
|
||||||
|
ret = regmap_write(wdt->da9063->regmap, DA9063_REG_CONTROL_F,
|
||||||
|
DA9063_SHUTDOWN);
|
||||||
|
if (ret)
|
||||||
|
dev_alert(wdt->da9063->dev, "Failed to shutdown (err = %d)\n",
|
||||||
|
ret);
|
||||||
|
|
||||||
|
return NOTIFY_DONE;
|
||||||
|
}
|
||||||
|
|
||||||
static const struct watchdog_info da9063_watchdog_info = {
|
static const struct watchdog_info da9063_watchdog_info = {
|
||||||
.options = WDIOF_SETTIMEOUT | WDIOF_KEEPALIVEPING,
|
.options = WDIOF_SETTIMEOUT | WDIOF_KEEPALIVEPING,
|
||||||
.identity = "DA9063 Watchdog",
|
.identity = "DA9063 Watchdog",
|
||||||
@ -163,14 +182,25 @@ static int da9063_wdt_probe(struct platform_device *pdev)
|
|||||||
dev_set_drvdata(&pdev->dev, wdt);
|
dev_set_drvdata(&pdev->dev, wdt);
|
||||||
|
|
||||||
ret = watchdog_register_device(&wdt->wdtdev);
|
ret = watchdog_register_device(&wdt->wdtdev);
|
||||||
|
if (ret)
|
||||||
|
return ret;
|
||||||
|
|
||||||
return ret;
|
wdt->restart_handler.notifier_call = da9063_wdt_restart_handler;
|
||||||
|
wdt->restart_handler.priority = 128;
|
||||||
|
ret = register_restart_handler(&wdt->restart_handler);
|
||||||
|
if (ret)
|
||||||
|
dev_err(wdt->da9063->dev,
|
||||||
|
"Failed to register restart handler (err = %d)\n", ret);
|
||||||
|
|
||||||
|
return 0;
|
||||||
}
|
}
|
||||||
|
|
||||||
static int da9063_wdt_remove(struct platform_device *pdev)
|
static int da9063_wdt_remove(struct platform_device *pdev)
|
||||||
{
|
{
|
||||||
struct da9063_watchdog *wdt = dev_get_drvdata(&pdev->dev);
|
struct da9063_watchdog *wdt = dev_get_drvdata(&pdev->dev);
|
||||||
|
|
||||||
|
unregister_restart_handler(&wdt->restart_handler);
|
||||||
|
|
||||||
watchdog_unregister_device(&wdt->wdtdev);
|
watchdog_unregister_device(&wdt->wdtdev);
|
||||||
|
|
||||||
return 0;
|
return 0;
|
||||||
|
Loading…
Reference in New Issue
Block a user