blob: 4064a43f1360a2fff166bd96caf81e9ceabaccaf [file] [log] [blame]
matthieu castet90074dc2009-06-05 18:57:18 +02001/*
2 * Watchdog driver for Broadcom BCM47XX
3 *
4 * Copyright (C) 2008 Aleksandar Radovanovic <biblbroks@sezampro.rs>
5 * Copyright (C) 2009 Matthieu CASTET <castet.matthieu@free.fr>
Hauke Mehrtensf82dedf2013-01-24 18:13:34 +01006 * Copyright (C) 2012-2013 Hauke Mehrtens <hauke@hauke-m.de>
matthieu castet90074dc2009-06-05 18:57:18 +02007 *
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.
12 */
13
Joe Perches27c766a2012-02-15 15:06:19 -080014#define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
15
Hauke Mehrtensf82dedf2013-01-24 18:13:34 +010016#include <linux/bcm47xx_wdt.h>
matthieu castet90074dc2009-06-05 18:57:18 +020017#include <linux/bitops.h>
18#include <linux/errno.h>
matthieu castet90074dc2009-06-05 18:57:18 +020019#include <linux/kernel.h>
matthieu castet90074dc2009-06-05 18:57:18 +020020#include <linux/module.h>
21#include <linux/moduleparam.h>
Hauke Mehrtensf82dedf2013-01-24 18:13:34 +010022#include <linux/platform_device.h>
matthieu castet90074dc2009-06-05 18:57:18 +020023#include <linux/reboot.h>
24#include <linux/types.h>
matthieu castet90074dc2009-06-05 18:57:18 +020025#include <linux/watchdog.h>
26#include <linux/timer.h>
27#include <linux/jiffies.h>
matthieu castet90074dc2009-06-05 18:57:18 +020028
29#define DRV_NAME "bcm47xx_wdt"
30
31#define WDT_DEFAULT_TIME 30 /* seconds */
Hauke Mehrtensa3906892013-01-12 18:14:09 +010032#define WDT_SOFTTIMER_MAX 255 /* seconds */
Hauke Mehrtense3e83d02013-01-12 18:14:11 +010033#define WDT_SOFTTIMER_THRESHOLD 60 /* seconds */
matthieu castet90074dc2009-06-05 18:57:18 +020034
Hauke Mehrtens93aed1f2013-01-12 18:14:10 +010035static int timeout = WDT_DEFAULT_TIME;
Wim Van Sebroeck86a1e182012-03-05 16:51:11 +010036static bool nowayout = WATCHDOG_NOWAYOUT;
matthieu castet90074dc2009-06-05 18:57:18 +020037
Hauke Mehrtens93aed1f2013-01-12 18:14:10 +010038module_param(timeout, int, 0);
39MODULE_PARM_DESC(timeout, "Watchdog time in seconds. (default="
matthieu castet90074dc2009-06-05 18:57:18 +020040 __MODULE_STRING(WDT_DEFAULT_TIME) ")");
41
Wim Van Sebroeck86a1e182012-03-05 16:51:11 +010042module_param(nowayout, bool, 0);
matthieu castet90074dc2009-06-05 18:57:18 +020043MODULE_PARM_DESC(nowayout,
44 "Watchdog cannot be stopped once started (default="
45 __MODULE_STRING(WATCHDOG_NOWAYOUT) ")");
matthieu castet90074dc2009-06-05 18:57:18 +020046
Hauke Mehrtensf82dedf2013-01-24 18:13:34 +010047static inline struct bcm47xx_wdt *bcm47xx_wdt_get(struct watchdog_device *wdd)
matthieu castet90074dc2009-06-05 18:57:18 +020048{
Hauke Mehrtensf82dedf2013-01-24 18:13:34 +010049 return container_of(wdd, struct bcm47xx_wdt, wdd);
matthieu castet90074dc2009-06-05 18:57:18 +020050}
51
Hauke Mehrtense3e83d02013-01-12 18:14:11 +010052static int bcm47xx_wdt_hard_keepalive(struct watchdog_device *wdd)
53{
54 struct bcm47xx_wdt *wdt = bcm47xx_wdt_get(wdd);
55
56 wdt->timer_set_ms(wdt, wdd->timeout * 1000);
57
58 return 0;
59}
60
61static int bcm47xx_wdt_hard_start(struct watchdog_device *wdd)
62{
63 return 0;
64}
65
66static int bcm47xx_wdt_hard_stop(struct watchdog_device *wdd)
67{
68 struct bcm47xx_wdt *wdt = bcm47xx_wdt_get(wdd);
69
70 wdt->timer_set(wdt, 0);
71
72 return 0;
73}
74
75static int bcm47xx_wdt_hard_set_timeout(struct watchdog_device *wdd,
76 unsigned int new_time)
77{
78 struct bcm47xx_wdt *wdt = bcm47xx_wdt_get(wdd);
79 u32 max_timer = wdt->max_timer_ms;
80
81 if (new_time < 1 || new_time > max_timer / 1000) {
82 pr_warn("timeout value must be 1<=x<=%d, using %d\n",
83 max_timer / 1000, new_time);
84 return -EINVAL;
85 }
86
87 wdd->timeout = new_time;
88 return 0;
89}
90
91static struct watchdog_ops bcm47xx_wdt_hard_ops = {
92 .owner = THIS_MODULE,
93 .start = bcm47xx_wdt_hard_start,
94 .stop = bcm47xx_wdt_hard_stop,
95 .ping = bcm47xx_wdt_hard_keepalive,
96 .set_timeout = bcm47xx_wdt_hard_set_timeout,
97};
98
Hauke Mehrtensa3906892013-01-12 18:14:09 +010099static void bcm47xx_wdt_soft_timer_tick(unsigned long data)
matthieu castet90074dc2009-06-05 18:57:18 +0200100{
Hauke Mehrtensf82dedf2013-01-24 18:13:34 +0100101 struct bcm47xx_wdt *wdt = (struct bcm47xx_wdt *)data;
102 u32 next_tick = min(wdt->wdd.timeout * 1000, wdt->max_timer_ms);
matthieu castet90074dc2009-06-05 18:57:18 +0200103
Hauke Mehrtensf82dedf2013-01-24 18:13:34 +0100104 if (!atomic_dec_and_test(&wdt->soft_ticks)) {
105 wdt->timer_set_ms(wdt, next_tick);
106 mod_timer(&wdt->soft_timer, jiffies + HZ);
matthieu castet90074dc2009-06-05 18:57:18 +0200107 } else {
Joe Perches27c766a2012-02-15 15:06:19 -0800108 pr_crit("Watchdog will fire soon!!!\n");
matthieu castet90074dc2009-06-05 18:57:18 +0200109 }
110}
111
Hauke Mehrtensa3906892013-01-12 18:14:09 +0100112static int bcm47xx_wdt_soft_keepalive(struct watchdog_device *wdd)
matthieu castet90074dc2009-06-05 18:57:18 +0200113{
Hauke Mehrtensf82dedf2013-01-24 18:13:34 +0100114 struct bcm47xx_wdt *wdt = bcm47xx_wdt_get(wdd);
115
116 atomic_set(&wdt->soft_ticks, wdd->timeout);
Hauke Mehrtens5434a042013-01-12 18:14:07 +0100117
118 return 0;
matthieu castet90074dc2009-06-05 18:57:18 +0200119}
120
Hauke Mehrtensa3906892013-01-12 18:14:09 +0100121static int bcm47xx_wdt_soft_start(struct watchdog_device *wdd)
matthieu castet90074dc2009-06-05 18:57:18 +0200122{
Hauke Mehrtensf82dedf2013-01-24 18:13:34 +0100123 struct bcm47xx_wdt *wdt = bcm47xx_wdt_get(wdd);
124
Hauke Mehrtensa3906892013-01-12 18:14:09 +0100125 bcm47xx_wdt_soft_keepalive(wdd);
126 bcm47xx_wdt_soft_timer_tick((unsigned long)wdt);
Hauke Mehrtens5434a042013-01-12 18:14:07 +0100127
128 return 0;
matthieu castet90074dc2009-06-05 18:57:18 +0200129}
130
Hauke Mehrtensa3906892013-01-12 18:14:09 +0100131static int bcm47xx_wdt_soft_stop(struct watchdog_device *wdd)
matthieu castet90074dc2009-06-05 18:57:18 +0200132{
Hauke Mehrtensf82dedf2013-01-24 18:13:34 +0100133 struct bcm47xx_wdt *wdt = bcm47xx_wdt_get(wdd);
134
135 del_timer_sync(&wdt->soft_timer);
136 wdt->timer_set(wdt, 0);
Hauke Mehrtens5434a042013-01-12 18:14:07 +0100137
138 return 0;
matthieu castet90074dc2009-06-05 18:57:18 +0200139}
140
Hauke Mehrtensa3906892013-01-12 18:14:09 +0100141static int bcm47xx_wdt_soft_set_timeout(struct watchdog_device *wdd,
142 unsigned int new_time)
matthieu castet90074dc2009-06-05 18:57:18 +0200143{
Hauke Mehrtensa3906892013-01-12 18:14:09 +0100144 if (new_time < 1 || new_time > WDT_SOFTTIMER_MAX) {
Hauke Mehrtensf82dedf2013-01-24 18:13:34 +0100145 pr_warn("timeout value must be 1<=x<=%d, using %d\n",
Hauke Mehrtensa3906892013-01-12 18:14:09 +0100146 WDT_SOFTTIMER_MAX, new_time);
matthieu castet90074dc2009-06-05 18:57:18 +0200147 return -EINVAL;
Hauke Mehrtensf82dedf2013-01-24 18:13:34 +0100148 }
matthieu castet90074dc2009-06-05 18:57:18 +0200149
Hauke Mehrtensf82dedf2013-01-24 18:13:34 +0100150 wdd->timeout = new_time;
matthieu castet90074dc2009-06-05 18:57:18 +0200151 return 0;
152}
153
Wim Van Sebroeck42747d72009-12-26 18:55:22 +0000154static const struct watchdog_info bcm47xx_wdt_info = {
Wim Van Sebroeck5f3b2752011-02-23 20:04:38 +0000155 .identity = DRV_NAME,
156 .options = WDIOF_SETTIMEOUT |
matthieu castet90074dc2009-06-05 18:57:18 +0200157 WDIOF_KEEPALIVEPING |
158 WDIOF_MAGICCLOSE,
159};
160
matthieu castet90074dc2009-06-05 18:57:18 +0200161static int bcm47xx_wdt_notify_sys(struct notifier_block *this,
Hauke Mehrtens5434a042013-01-12 18:14:07 +0100162 unsigned long code, void *unused)
matthieu castet90074dc2009-06-05 18:57:18 +0200163{
Hauke Mehrtensf82dedf2013-01-24 18:13:34 +0100164 struct bcm47xx_wdt *wdt;
165
166 wdt = container_of(this, struct bcm47xx_wdt, notifier);
matthieu castet90074dc2009-06-05 18:57:18 +0200167 if (code == SYS_DOWN || code == SYS_HALT)
Hauke Mehrtensf82dedf2013-01-24 18:13:34 +0100168 wdt->wdd.ops->stop(&wdt->wdd);
matthieu castet90074dc2009-06-05 18:57:18 +0200169 return NOTIFY_DONE;
170}
171
Rafał Miłecki1cc74952015-01-25 11:40:57 +0100172static int bcm47xx_wdt_restart(struct notifier_block *this, unsigned long mode,
173 void *cmd)
174{
175 struct bcm47xx_wdt *wdt;
176
177 wdt = container_of(this, struct bcm47xx_wdt, restart_handler);
178 wdt->timer_set(wdt, 1);
179
180 return NOTIFY_DONE;
181}
182
Hauke Mehrtensa3906892013-01-12 18:14:09 +0100183static struct watchdog_ops bcm47xx_wdt_soft_ops = {
matthieu castet90074dc2009-06-05 18:57:18 +0200184 .owner = THIS_MODULE,
Hauke Mehrtensa3906892013-01-12 18:14:09 +0100185 .start = bcm47xx_wdt_soft_start,
186 .stop = bcm47xx_wdt_soft_stop,
187 .ping = bcm47xx_wdt_soft_keepalive,
188 .set_timeout = bcm47xx_wdt_soft_set_timeout,
matthieu castet90074dc2009-06-05 18:57:18 +0200189};
190
Hauke Mehrtensf82dedf2013-01-24 18:13:34 +0100191static int bcm47xx_wdt_probe(struct platform_device *pdev)
matthieu castet90074dc2009-06-05 18:57:18 +0200192{
193 int ret;
Hauke Mehrtense3e83d02013-01-12 18:14:11 +0100194 bool soft;
Hauke Mehrtensf82dedf2013-01-24 18:13:34 +0100195 struct bcm47xx_wdt *wdt = dev_get_platdata(&pdev->dev);
matthieu castet90074dc2009-06-05 18:57:18 +0200196
Hauke Mehrtensf82dedf2013-01-24 18:13:34 +0100197 if (!wdt)
198 return -ENXIO;
matthieu castet90074dc2009-06-05 18:57:18 +0200199
Hauke Mehrtense3e83d02013-01-12 18:14:11 +0100200 soft = wdt->max_timer_ms < WDT_SOFTTIMER_THRESHOLD * 1000;
matthieu castet90074dc2009-06-05 18:57:18 +0200201
Hauke Mehrtense3e83d02013-01-12 18:14:11 +0100202 if (soft) {
203 wdt->wdd.ops = &bcm47xx_wdt_soft_ops;
204 setup_timer(&wdt->soft_timer, bcm47xx_wdt_soft_timer_tick,
205 (long unsigned int)wdt);
206 } else {
207 wdt->wdd.ops = &bcm47xx_wdt_hard_ops;
208 }
209
Hauke Mehrtensf82dedf2013-01-24 18:13:34 +0100210 wdt->wdd.info = &bcm47xx_wdt_info;
211 wdt->wdd.timeout = WDT_DEFAULT_TIME;
Pratyush Anand65518812015-08-20 14:05:01 +0530212 wdt->wdd.parent = &pdev->dev;
Hauke Mehrtensf82dedf2013-01-24 18:13:34 +0100213 ret = wdt->wdd.ops->set_timeout(&wdt->wdd, timeout);
matthieu castet90074dc2009-06-05 18:57:18 +0200214 if (ret)
Hauke Mehrtensf82dedf2013-01-24 18:13:34 +0100215 goto err_timer;
216 watchdog_set_nowayout(&wdt->wdd, nowayout);
matthieu castet90074dc2009-06-05 18:57:18 +0200217
Hauke Mehrtensf82dedf2013-01-24 18:13:34 +0100218 wdt->notifier.notifier_call = &bcm47xx_wdt_notify_sys;
219
220 ret = register_reboot_notifier(&wdt->notifier);
221 if (ret)
222 goto err_timer;
223
Rafał Miłecki1cc74952015-01-25 11:40:57 +0100224 wdt->restart_handler.notifier_call = &bcm47xx_wdt_restart;
225 wdt->restart_handler.priority = 64;
226 ret = register_restart_handler(&wdt->restart_handler);
Hauke Mehrtensf82dedf2013-01-24 18:13:34 +0100227 if (ret)
228 goto err_notifier;
matthieu castet90074dc2009-06-05 18:57:18 +0200229
Rafał Miłecki1cc74952015-01-25 11:40:57 +0100230 ret = watchdog_register_device(&wdt->wdd);
231 if (ret)
232 goto err_handler;
233
Hauke Mehrtense3e83d02013-01-12 18:14:11 +0100234 dev_info(&pdev->dev, "BCM47xx Watchdog Timer enabled (%d seconds%s%s)\n",
235 timeout, nowayout ? ", nowayout" : "",
236 soft ? ", Software Timer" : "");
matthieu castet90074dc2009-06-05 18:57:18 +0200237 return 0;
Hauke Mehrtensf82dedf2013-01-24 18:13:34 +0100238
Rafał Miłecki1cc74952015-01-25 11:40:57 +0100239err_handler:
240 unregister_restart_handler(&wdt->restart_handler);
Hauke Mehrtensf82dedf2013-01-24 18:13:34 +0100241err_notifier:
242 unregister_reboot_notifier(&wdt->notifier);
243err_timer:
Hauke Mehrtense3e83d02013-01-12 18:14:11 +0100244 if (soft)
245 del_timer_sync(&wdt->soft_timer);
Hauke Mehrtensf82dedf2013-01-24 18:13:34 +0100246
247 return ret;
matthieu castet90074dc2009-06-05 18:57:18 +0200248}
249
Hauke Mehrtensf82dedf2013-01-24 18:13:34 +0100250static int bcm47xx_wdt_remove(struct platform_device *pdev)
matthieu castet90074dc2009-06-05 18:57:18 +0200251{
Hauke Mehrtensf82dedf2013-01-24 18:13:34 +0100252 struct bcm47xx_wdt *wdt = dev_get_platdata(&pdev->dev);
matthieu castet90074dc2009-06-05 18:57:18 +0200253
Hauke Mehrtensf82dedf2013-01-24 18:13:34 +0100254 if (!wdt)
255 return -ENXIO;
256
257 watchdog_unregister_device(&wdt->wdd);
258 unregister_reboot_notifier(&wdt->notifier);
259
260 return 0;
matthieu castet90074dc2009-06-05 18:57:18 +0200261}
262
Hauke Mehrtensf82dedf2013-01-24 18:13:34 +0100263static struct platform_driver bcm47xx_wdt_driver = {
264 .driver = {
Hauke Mehrtensf82dedf2013-01-24 18:13:34 +0100265 .name = "bcm47xx-wdt",
266 },
267 .probe = bcm47xx_wdt_probe,
268 .remove = bcm47xx_wdt_remove,
269};
270
271module_platform_driver(bcm47xx_wdt_driver);
matthieu castet90074dc2009-06-05 18:57:18 +0200272
273MODULE_AUTHOR("Aleksandar Radovanovic");
Hauke Mehrtensf82dedf2013-01-24 18:13:34 +0100274MODULE_AUTHOR("Hauke Mehrtens <hauke@hauke-m.de>");
matthieu castet90074dc2009-06-05 18:57:18 +0200275MODULE_DESCRIPTION("Watchdog driver for Broadcom BCM47xx");
276MODULE_LICENSE("GPL");