Message ID | 1457040025-1108-3-git-send-email-slemieux.tyco@gmail.com (mailing list archive) |
---|---|
State | New, archived |
Headers | show |
On 03/03/2016 01:20 PM, Sylvain Lemieux wrote: > From: Sylvain Lemieux <slemieux@tycoint.com> > > Add restart handler capability to the driver; > the restart handler implementation was taken from > "mach-lpc32xx" ("lpc23xx_restart" function). > > Signed-off-by: Sylvain Lemieux <slemieux@tycoint.com> Reviewed-by: Guenter Roeck <linux@roeck-us.net> > --- > Changes from v5 to v6: > - none. > > Changes from v4 to v5: > - Rebased on the following patch: > http://permalink.gmane.org/gmane.linux.watchdog/3364/ > > Changes from v3 to v4: > - none. > > Changes from v2 to v3: > - remove explicit clock enable from restart handler. > - verify "register_restart_handler" return value. > - add call to unregister_restart_handler". > - do the restart handling directly in "pnx4008_restart_handler". > > Changes from v1 to v2: > - new patch in v2. > > drivers/watchdog/pnx4008_wdt.c | 17 +++++++++++++++++ > 1 file changed, 17 insertions(+) > > diff --git a/drivers/watchdog/pnx4008_wdt.c b/drivers/watchdog/pnx4008_wdt.c > index 88264a2..f3be522 100644 > --- a/drivers/watchdog/pnx4008_wdt.c > +++ b/drivers/watchdog/pnx4008_wdt.c > @@ -31,6 +31,8 @@ > #include <linux/slab.h> > #include <linux/err.h> > #include <linux/of.h> > +#include <linux/delay.h> > +#include <linux/reboot.h> > #include <mach/hardware.h> > > /* WatchDog Timer - Chapter 23 Page 207 */ > @@ -124,6 +126,19 @@ static int pnx4008_wdt_set_timeout(struct watchdog_device *wdd, > return 0; > } > > +static int pnx4008_restart_handler(struct watchdog_device *wdd, > + unsigned long mode, void *cmd) > +{ > + /* Instant assert of RESETOUT_N with pulse length 1mS */ > + writel(13000, WDTIM_PULSE(wdt_base)); > + writel(M_RES2 | RESFRC1 | RESFRC2, WDTIM_MCTRL(wdt_base)); > + > + /* Wait for watchdog to reset system */ > + mdelay(1000); > + > + return NOTIFY_DONE; > +} > + > static const struct watchdog_info pnx4008_wdt_ident = { > .options = WDIOF_CARDRESET | WDIOF_MAGICCLOSE | > WDIOF_SETTIMEOUT | WDIOF_KEEPALIVEPING, > @@ -135,6 +150,7 @@ static const struct watchdog_ops pnx4008_wdt_ops = { > .start = pnx4008_wdt_start, > .stop = pnx4008_wdt_stop, > .set_timeout = pnx4008_wdt_set_timeout, > + .restart = pnx4008_restart_handler, > }; > > static struct watchdog_device pnx4008_wdd = { > @@ -169,6 +185,7 @@ static int pnx4008_wdt_probe(struct platform_device *pdev) > WDIOF_CARDRESET : 0; > pnx4008_wdd.parent = &pdev->dev; > watchdog_set_nowayout(&pnx4008_wdd, nowayout); > + watchdog_set_restart_priority(&pnx4008_wdd, 128); > > pnx4008_wdt_stop(&pnx4008_wdd); /* disable for now */ > >
diff --git a/drivers/watchdog/pnx4008_wdt.c b/drivers/watchdog/pnx4008_wdt.c index 88264a2..f3be522 100644 --- a/drivers/watchdog/pnx4008_wdt.c +++ b/drivers/watchdog/pnx4008_wdt.c @@ -31,6 +31,8 @@ #include <linux/slab.h> #include <linux/err.h> #include <linux/of.h> +#include <linux/delay.h> +#include <linux/reboot.h> #include <mach/hardware.h> /* WatchDog Timer - Chapter 23 Page 207 */ @@ -124,6 +126,19 @@ static int pnx4008_wdt_set_timeout(struct watchdog_device *wdd, return 0; } +static int pnx4008_restart_handler(struct watchdog_device *wdd, + unsigned long mode, void *cmd) +{ + /* Instant assert of RESETOUT_N with pulse length 1mS */ + writel(13000, WDTIM_PULSE(wdt_base)); + writel(M_RES2 | RESFRC1 | RESFRC2, WDTIM_MCTRL(wdt_base)); + + /* Wait for watchdog to reset system */ + mdelay(1000); + + return NOTIFY_DONE; +} + static const struct watchdog_info pnx4008_wdt_ident = { .options = WDIOF_CARDRESET | WDIOF_MAGICCLOSE | WDIOF_SETTIMEOUT | WDIOF_KEEPALIVEPING, @@ -135,6 +150,7 @@ static const struct watchdog_ops pnx4008_wdt_ops = { .start = pnx4008_wdt_start, .stop = pnx4008_wdt_stop, .set_timeout = pnx4008_wdt_set_timeout, + .restart = pnx4008_restart_handler, }; static struct watchdog_device pnx4008_wdd = { @@ -169,6 +185,7 @@ static int pnx4008_wdt_probe(struct platform_device *pdev) WDIOF_CARDRESET : 0; pnx4008_wdd.parent = &pdev->dev; watchdog_set_nowayout(&pnx4008_wdd, nowayout); + watchdog_set_restart_priority(&pnx4008_wdd, 128); pnx4008_wdt_stop(&pnx4008_wdd); /* disable for now */