watchdog: mtk_wdt: use core restart handler

Get rid of the custom restart handler by using the one provided by the
watchdog core.

Signed-off-by: Damien Riegel <damien.riegel@savoirfairelinux.com>
Reviewed-by: Guenter Roeck <linux@roeck-us.net>
Reviewed-by: Vivien Didelot <vivien.didelot@savoirfairelinux.com>
Signed-off-by: Guenter Roeck <linux@roeck-us.net>
Signed-off-by: Wim Van Sebroeck <wim@iguana.be>
This commit is contained in:
Damien Riegel 2015-11-16 12:28:08 -05:00 committed by Wim Van Sebroeck
parent 46c17f0f91
commit e86adc3f63
1 changed files with 5 additions and 17 deletions

View File

@ -28,8 +28,6 @@
#include <linux/platform_device.h> #include <linux/platform_device.h>
#include <linux/types.h> #include <linux/types.h>
#include <linux/watchdog.h> #include <linux/watchdog.h>
#include <linux/notifier.h>
#include <linux/reboot.h>
#include <linux/delay.h> #include <linux/delay.h>
#define WDT_MAX_TIMEOUT 31 #define WDT_MAX_TIMEOUT 31
@ -64,16 +62,13 @@ static unsigned int timeout = WDT_MAX_TIMEOUT;
struct mtk_wdt_dev { struct mtk_wdt_dev {
struct watchdog_device wdt_dev; struct watchdog_device wdt_dev;
void __iomem *wdt_base; void __iomem *wdt_base;
struct notifier_block restart_handler;
}; };
static int mtk_reset_handler(struct notifier_block *this, unsigned long mode, static int mtk_wdt_restart(struct watchdog_device *wdt_dev)
void *cmd)
{ {
struct mtk_wdt_dev *mtk_wdt; struct mtk_wdt_dev *mtk_wdt = watchdog_get_drvdata(wdt_dev);
void __iomem *wdt_base; void __iomem *wdt_base;
mtk_wdt = container_of(this, struct mtk_wdt_dev, restart_handler);
wdt_base = mtk_wdt->wdt_base; wdt_base = mtk_wdt->wdt_base;
while (1) { while (1) {
@ -81,7 +76,7 @@ static int mtk_reset_handler(struct notifier_block *this, unsigned long mode,
mdelay(5); mdelay(5);
} }
return NOTIFY_DONE; return 0;
} }
static int mtk_wdt_ping(struct watchdog_device *wdt_dev) static int mtk_wdt_ping(struct watchdog_device *wdt_dev)
@ -161,6 +156,7 @@ static const struct watchdog_ops mtk_wdt_ops = {
.stop = mtk_wdt_stop, .stop = mtk_wdt_stop,
.ping = mtk_wdt_ping, .ping = mtk_wdt_ping,
.set_timeout = mtk_wdt_set_timeout, .set_timeout = mtk_wdt_set_timeout,
.restart = mtk_wdt_restart,
}; };
static int mtk_wdt_probe(struct platform_device *pdev) static int mtk_wdt_probe(struct platform_device *pdev)
@ -189,6 +185,7 @@ static int mtk_wdt_probe(struct platform_device *pdev)
watchdog_init_timeout(&mtk_wdt->wdt_dev, timeout, &pdev->dev); watchdog_init_timeout(&mtk_wdt->wdt_dev, timeout, &pdev->dev);
watchdog_set_nowayout(&mtk_wdt->wdt_dev, nowayout); watchdog_set_nowayout(&mtk_wdt->wdt_dev, nowayout);
watchdog_set_restart_priority(&mtk_wdt->wdt_dev, 128);
watchdog_set_drvdata(&mtk_wdt->wdt_dev, mtk_wdt); watchdog_set_drvdata(&mtk_wdt->wdt_dev, mtk_wdt);
@ -198,13 +195,6 @@ static int mtk_wdt_probe(struct platform_device *pdev)
if (unlikely(err)) if (unlikely(err))
return err; return err;
mtk_wdt->restart_handler.notifier_call = mtk_reset_handler;
mtk_wdt->restart_handler.priority = 128;
err = register_restart_handler(&mtk_wdt->restart_handler);
if (err)
dev_warn(&pdev->dev,
"cannot register restart handler (err=%d)\n", err);
dev_info(&pdev->dev, "Watchdog enabled (timeout=%d sec, nowayout=%d)\n", dev_info(&pdev->dev, "Watchdog enabled (timeout=%d sec, nowayout=%d)\n",
mtk_wdt->wdt_dev.timeout, nowayout); mtk_wdt->wdt_dev.timeout, nowayout);
@ -223,8 +213,6 @@ static int mtk_wdt_remove(struct platform_device *pdev)
{ {
struct mtk_wdt_dev *mtk_wdt = platform_get_drvdata(pdev); struct mtk_wdt_dev *mtk_wdt = platform_get_drvdata(pdev);
unregister_restart_handler(&mtk_wdt->restart_handler);
watchdog_unregister_device(&mtk_wdt->wdt_dev); watchdog_unregister_device(&mtk_wdt->wdt_dev);
return 0; return 0;