2 * Watchdog driver for Broadcom BCM47XX
4 * Copyright (C) 2008 Aleksandar Radovanovic <biblbroks@sezampro.rs>
5 * Copyright (C) 2009 Matthieu CASTET <castet.matthieu@free.fr>
6 * Copyright (C) 2012-2013 Hauke Mehrtens <hauke@hauke-m.de>
8 * This program is free software; you can redistribute it and/or
9 * modify it under the terms of the GNU General Public License
10 * as published by the Free Software Foundation; either version
11 * 2 of the License, or (at your option) any later version.
14 #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
16 #include <linux/bcm47xx_wdt.h>
17 #include <linux/bitops.h>
18 #include <linux/errno.h>
19 #include <linux/init.h>
20 #include <linux/kernel.h>
21 #include <linux/module.h>
22 #include <linux/moduleparam.h>
23 #include <linux/platform_device.h>
24 #include <linux/reboot.h>
25 #include <linux/types.h>
26 #include <linux/watchdog.h>
27 #include <linux/timer.h>
28 #include <linux/jiffies.h>
30 #define DRV_NAME "bcm47xx_wdt"
32 #define WDT_DEFAULT_TIME 30 /* seconds */
33 #define WDT_SOFTTIMER_MAX 255 /* seconds */
35 static int timeout
= WDT_DEFAULT_TIME
;
36 static bool nowayout
= WATCHDOG_NOWAYOUT
;
38 module_param(timeout
, int, 0);
39 MODULE_PARM_DESC(timeout
, "Watchdog time in seconds. (default="
40 __MODULE_STRING(WDT_DEFAULT_TIME
) ")");
42 module_param(nowayout
, bool, 0);
43 MODULE_PARM_DESC(nowayout
,
44 "Watchdog cannot be stopped once started (default="
45 __MODULE_STRING(WATCHDOG_NOWAYOUT
) ")");
47 static inline struct bcm47xx_wdt
*bcm47xx_wdt_get(struct watchdog_device
*wdd
)
49 return container_of(wdd
, struct bcm47xx_wdt
, wdd
);
52 static void bcm47xx_wdt_soft_timer_tick(unsigned long data
)
54 struct bcm47xx_wdt
*wdt
= (struct bcm47xx_wdt
*)data
;
55 u32 next_tick
= min(wdt
->wdd
.timeout
* 1000, wdt
->max_timer_ms
);
57 if (!atomic_dec_and_test(&wdt
->soft_ticks
)) {
58 wdt
->timer_set_ms(wdt
, next_tick
);
59 mod_timer(&wdt
->soft_timer
, jiffies
+ HZ
);
61 pr_crit("Watchdog will fire soon!!!\n");
65 static int bcm47xx_wdt_soft_keepalive(struct watchdog_device
*wdd
)
67 struct bcm47xx_wdt
*wdt
= bcm47xx_wdt_get(wdd
);
69 atomic_set(&wdt
->soft_ticks
, wdd
->timeout
);
74 static int bcm47xx_wdt_soft_start(struct watchdog_device
*wdd
)
76 struct bcm47xx_wdt
*wdt
= bcm47xx_wdt_get(wdd
);
78 bcm47xx_wdt_soft_keepalive(wdd
);
79 bcm47xx_wdt_soft_timer_tick((unsigned long)wdt
);
84 static int bcm47xx_wdt_soft_stop(struct watchdog_device
*wdd
)
86 struct bcm47xx_wdt
*wdt
= bcm47xx_wdt_get(wdd
);
88 del_timer_sync(&wdt
->soft_timer
);
89 wdt
->timer_set(wdt
, 0);
94 static int bcm47xx_wdt_soft_set_timeout(struct watchdog_device
*wdd
,
95 unsigned int new_time
)
97 if (new_time
< 1 || new_time
> WDT_SOFTTIMER_MAX
) {
98 pr_warn("timeout value must be 1<=x<=%d, using %d\n",
99 WDT_SOFTTIMER_MAX
, new_time
);
103 wdd
->timeout
= new_time
;
107 static const struct watchdog_info bcm47xx_wdt_info
= {
108 .identity
= DRV_NAME
,
109 .options
= WDIOF_SETTIMEOUT
|
110 WDIOF_KEEPALIVEPING
|
114 static int bcm47xx_wdt_notify_sys(struct notifier_block
*this,
115 unsigned long code
, void *unused
)
117 struct bcm47xx_wdt
*wdt
;
119 wdt
= container_of(this, struct bcm47xx_wdt
, notifier
);
120 if (code
== SYS_DOWN
|| code
== SYS_HALT
)
121 wdt
->wdd
.ops
->stop(&wdt
->wdd
);
125 static struct watchdog_ops bcm47xx_wdt_soft_ops
= {
126 .owner
= THIS_MODULE
,
127 .start
= bcm47xx_wdt_soft_start
,
128 .stop
= bcm47xx_wdt_soft_stop
,
129 .ping
= bcm47xx_wdt_soft_keepalive
,
130 .set_timeout
= bcm47xx_wdt_soft_set_timeout
,
133 static int bcm47xx_wdt_probe(struct platform_device
*pdev
)
136 struct bcm47xx_wdt
*wdt
= dev_get_platdata(&pdev
->dev
);
141 setup_timer(&wdt
->soft_timer
, bcm47xx_wdt_soft_timer_tick
,
142 (long unsigned int)wdt
);
144 wdt
->wdd
.ops
= &bcm47xx_wdt_soft_ops
;
145 wdt
->wdd
.info
= &bcm47xx_wdt_info
;
146 wdt
->wdd
.timeout
= WDT_DEFAULT_TIME
;
147 ret
= wdt
->wdd
.ops
->set_timeout(&wdt
->wdd
, timeout
);
150 watchdog_set_nowayout(&wdt
->wdd
, nowayout
);
152 wdt
->notifier
.notifier_call
= &bcm47xx_wdt_notify_sys
;
154 ret
= register_reboot_notifier(&wdt
->notifier
);
158 ret
= watchdog_register_device(&wdt
->wdd
);
162 pr_info("BCM47xx Watchdog Timer enabled (%d seconds%s)\n",
163 timeout
, nowayout
? ", nowayout" : "");
167 unregister_reboot_notifier(&wdt
->notifier
);
169 del_timer_sync(&wdt
->soft_timer
);
174 static int bcm47xx_wdt_remove(struct platform_device
*pdev
)
176 struct bcm47xx_wdt
*wdt
= dev_get_platdata(&pdev
->dev
);
181 watchdog_unregister_device(&wdt
->wdd
);
182 unregister_reboot_notifier(&wdt
->notifier
);
187 static struct platform_driver bcm47xx_wdt_driver
= {
189 .owner
= THIS_MODULE
,
190 .name
= "bcm47xx-wdt",
192 .probe
= bcm47xx_wdt_probe
,
193 .remove
= bcm47xx_wdt_remove
,
196 module_platform_driver(bcm47xx_wdt_driver
);
198 MODULE_AUTHOR("Aleksandar Radovanovic");
199 MODULE_AUTHOR("Hauke Mehrtens <hauke@hauke-m.de>");
200 MODULE_DESCRIPTION("Watchdog driver for Broadcom BCM47xx");
201 MODULE_LICENSE("GPL");