treewide: Add SPDX license identifier for more missed files
[linux-2.6-block.git] / drivers / watchdog / cpwd.c
CommitLineData
09c434b8 1// SPDX-License-Identifier: GPL-2.0-only
8ab0dc33 2/* cpwd.c - driver implementation for hardware watchdog
1da177e4
LT
3 * timers found on Sun Microsystems CP1400 and CP1500 boards.
4 *
927d6961 5 * This device supports both the generic Linux watchdog
1da177e4
LT
6 * interface and Solaris-compatible ioctls as best it is
7 * able.
8 *
5f3b2756
WVS
9 * NOTE: CP1400 systems appear to have a defective intr_mask
10 * register on the PLD, preventing the disabling of
11 * timer interrupts. We use a timer to periodically
12 * reset 'stopped' watchdogs on affected platforms.
1da177e4 13 *
1da177e4 14 * Copyright (c) 2000 Eric Brower (ebrower@usa.net)
c5f8556c 15 * Copyright (C) 2008 David S. Miller <davem@davemloft.net>
1da177e4
LT
16 */
17
27c766aa
JP
18#define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
19
1da177e4
LT
20#include <linux/kernel.h>
21#include <linux/module.h>
22#include <linux/fs.h>
23#include <linux/errno.h>
24#include <linux/major.h>
1da177e4 25#include <linux/miscdevice.h>
1da177e4
LT
26#include <linux/interrupt.h>
27#include <linux/ioport.h>
28#include <linux/timer.h>
5a0e3ad6 29#include <linux/slab.h>
613655fa 30#include <linux/mutex.h>
347e03df 31#include <linux/io.h>
c5f8556c
DM
32#include <linux/of.h>
33#include <linux/of_device.h>
278aefc5 34#include <linux/uaccess.h>
c5f8556c 35
1da177e4 36#include <asm/irq.h>
1da177e4
LT
37#include <asm/watchdog.h>
38
c5f8556c 39#define DRIVER_NAME "cpwd"
c5f8556c 40
1da177e4 41#define WD_OBPNAME "watchdog"
c5f8556c 42#define WD_BADMODEL "SUNW,501-5336"
1da177e4
LT
43#define WD_BTIMEOUT (jiffies + (HZ * 1000))
44#define WD_BLIMIT 0xFFFF
45
1da177e4 46#define WD0_MINOR 212
927d6961
WVS
47#define WD1_MINOR 213
48#define WD2_MINOR 214
1da177e4 49
c5f8556c
DM
50/* Internal driver definitions. */
51#define WD0_ID 0
52#define WD1_ID 1
53#define WD2_ID 2
54#define WD_NUMDEVS 3
1da177e4 55
c5f8556c
DM
56#define WD_INTR_OFF 0
57#define WD_INTR_ON 1
1da177e4
LT
58
59#define WD_STAT_INIT 0x01 /* Watchdog timer is initialized */
60#define WD_STAT_BSTOP 0x02 /* Watchdog timer is brokenstopped */
61#define WD_STAT_SVCD 0x04 /* Watchdog interrupt occurred */
62
63/* Register value definitions
64 */
65#define WD0_INTR_MASK 0x01 /* Watchdog device interrupt masks */
66#define WD1_INTR_MASK 0x02
67#define WD2_INTR_MASK 0x04
68
69#define WD_S_RUNNING 0x01 /* Watchdog device status running */
70#define WD_S_EXPIRED 0x02 /* Watchdog device status expired */
71
c5f8556c
DM
72struct cpwd {
73 void __iomem *regs;
74 spinlock_t lock;
75
76 unsigned int irq;
77
78 unsigned long timeout;
79 bool enabled;
80 bool reboot;
81 bool broken;
82 bool initialized;
83
84 struct {
85 struct miscdevice misc;
86 void __iomem *regs;
87 u8 intr_mask;
88 u8 runstatus;
89 u16 timeout;
90 } devs[WD_NUMDEVS];
91};
92
613655fa 93static DEFINE_MUTEX(cpwd_mutex);
c5f8556c
DM
94static struct cpwd *cpwd_device;
95
927d6961 96/* Sun uses Altera PLD EPF8820ATC144-4
1da177e4
LT
97 * providing three hardware watchdogs:
98 *
927d6961
WVS
99 * 1) RIC - sends an interrupt when triggered
100 * 2) XIR - asserts XIR_B_RESET when triggered, resets CPU
101 * 3) POR - asserts POR_B_RESET when triggered, resets CPU, backplane, board
1da177e4
LT
102 *
103 *** Timer register block definition (struct wd_timer_regblk)
104 *
927d6961 105 * dcntr and limit registers (halfword access):
1da177e4
LT
106 * -------------------
107 * | 15 | ...| 1 | 0 |
108 * -------------------
109 * |- counter val -|
110 * -------------------
5f3b2756
WVS
111 * dcntr - Current 16-bit downcounter value.
112 * When downcounter reaches '0' watchdog expires.
113 * Reading this register resets downcounter with
114 * 'limit' value.
115 * limit - 16-bit countdown value in 1/10th second increments.
116 * Writing this register begins countdown with input value.
117 * Reading from this register does not affect counter.
1da177e4
LT
118 * NOTES: After watchdog reset, dcntr and limit contain '1'
119 *
120 * status register (byte access):
121 * ---------------------------
122 * | 7 | ... | 2 | 1 | 0 |
123 * --------------+------------
124 * |- UNUSED -| EXP | RUN |
125 * ---------------------------
126 * status- Bit 0 - Watchdog is running
5f3b2756 127 * Bit 1 - Watchdog has expired
1da177e4
LT
128 *
129 *** PLD register block definition (struct wd_pld_regblk)
130 *
131 * intr_mask register (byte access):
132 * ---------------------------------
133 * | 7 | ... | 3 | 2 | 1 | 0 |
134 * +-------------+------------------
135 * |- UNUSED -| WD3 | WD2 | WD1 |
136 * ---------------------------------
137 * WD3 - 1 == Interrupt disabled for watchdog 3
138 * WD2 - 1 == Interrupt disabled for watchdog 2
139 * WD1 - 1 == Interrupt disabled for watchdog 1
140 *
141 * pld_status register (byte access):
142 * UNKNOWN, MAGICAL MYSTERY REGISTER
143 *
144 */
145#define WD_TIMER_REGSZ 16
146#define WD0_OFF 0
147#define WD1_OFF (WD_TIMER_REGSZ * 1)
148#define WD2_OFF (WD_TIMER_REGSZ * 2)
149#define PLD_OFF (WD_TIMER_REGSZ * 3)
150
151#define WD_DCNTR 0x00
152#define WD_LIMIT 0x04
153#define WD_STATUS 0x08
154
155#define PLD_IMASK (PLD_OFF + 0x00)
156#define PLD_STATUS (PLD_OFF + 0x04)
157
c5f8556c 158static struct timer_list cpwd_timer;
1da177e4 159
a77dba7e
WVS
160static int wd0_timeout;
161static int wd1_timeout;
162static int wd2_timeout;
1da177e4 163
927d6961 164module_param(wd0_timeout, int, 0);
1da177e4 165MODULE_PARM_DESC(wd0_timeout, "Default watchdog0 timeout in 1/10secs");
927d6961 166module_param(wd1_timeout, int, 0);
1da177e4 167MODULE_PARM_DESC(wd1_timeout, "Default watchdog1 timeout in 1/10secs");
927d6961 168module_param(wd2_timeout, int, 0);
1da177e4
LT
169MODULE_PARM_DESC(wd2_timeout, "Default watchdog2 timeout in 1/10secs");
170
c5f8556c
DM
171MODULE_AUTHOR("Eric Brower <ebrower@usa.net>");
172MODULE_DESCRIPTION("Hardware watchdog driver for Sun Microsystems CP1400/1500");
1da177e4 173MODULE_LICENSE("GPL");
c5f8556c
DM
174MODULE_SUPPORTED_DEVICE("watchdog");
175
176static void cpwd_writew(u16 val, void __iomem *addr)
177{
178 writew(cpu_to_le16(val), addr);
179}
180static u16 cpwd_readw(void __iomem *addr)
181{
182 u16 val = readw(addr);
183
184 return le16_to_cpu(val);
185}
186
187static void cpwd_writeb(u8 val, void __iomem *addr)
188{
189 writeb(val, addr);
190}
191
192static u8 cpwd_readb(void __iomem *addr)
193{
194 return readb(addr);
195}
1da177e4 196
c5f8556c
DM
197/* Enable or disable watchdog interrupts
198 * Because of the CP1400 defect this should only be
199 * called during initialzation or by wd_[start|stop]timer()
200 *
5f3b2756 201 * index - sub-device index, or -1 for 'all'
c5f8556c 202 * enable - non-zero to enable interrupts, zero to disable
1da177e4 203 */
c5f8556c
DM
204static void cpwd_toggleintr(struct cpwd *p, int index, int enable)
205{
206 unsigned char curregs = cpwd_readb(p->regs + PLD_IMASK);
927d6961
WVS
207 unsigned char setregs =
208 (index == -1) ?
209 (WD0_INTR_MASK | WD1_INTR_MASK | WD2_INTR_MASK) :
c5f8556c
DM
210 (p->devs[index].intr_mask);
211
212 if (enable == WD_INTR_ON)
213 curregs &= ~setregs;
214 else
215 curregs |= setregs;
216
217 cpwd_writeb(curregs, p->regs + PLD_IMASK);
218}
219
220/* Restarts timer with maximum limit value and
221 * does not unset 'brokenstop' value.
1da177e4 222 */
c5f8556c 223static void cpwd_resetbrokentimer(struct cpwd *p, int index)
1da177e4 224{
c5f8556c
DM
225 cpwd_toggleintr(p, index, WD_INTR_ON);
226 cpwd_writew(WD_BLIMIT, p->devs[index].regs + WD_LIMIT);
1da177e4
LT
227}
228
c5f8556c
DM
229/* Timer method called to reset stopped watchdogs--
230 * because of the PLD bug on CP1400, we cannot mask
231 * interrupts within the PLD so me must continually
232 * reset the timers ad infinitum.
233 */
4fa42b4e 234static void cpwd_brokentimer(struct timer_list *unused)
c5f8556c 235{
4fa42b4e 236 struct cpwd *p = cpwd_device;
c5f8556c
DM
237 int id, tripped = 0;
238
239 /* kill a running timer instance, in case we
240 * were called directly instead of by kernel timer
241 */
242 if (timer_pending(&cpwd_timer))
243 del_timer(&cpwd_timer);
1da177e4 244
c5f8556c
DM
245 for (id = 0; id < WD_NUMDEVS; id++) {
246 if (p->devs[id].runstatus & WD_STAT_BSTOP) {
247 ++tripped;
248 cpwd_resetbrokentimer(p, id);
249 }
250 }
1da177e4 251
c5f8556c
DM
252 if (tripped) {
253 /* there is at least one timer brokenstopped-- reschedule */
254 cpwd_timer.expires = WD_BTIMEOUT;
255 add_timer(&cpwd_timer);
256 }
257}
258
259/* Reset countdown timer with 'limit' value and continue countdown.
260 * This will not start a stopped timer.
1da177e4 261 */
c5f8556c 262static void cpwd_pingtimer(struct cpwd *p, int index)
1da177e4 263{
c5f8556c
DM
264 if (cpwd_readb(p->devs[index].regs + WD_STATUS) & WD_S_RUNNING)
265 cpwd_readw(p->devs[index].regs + WD_DCNTR);
1da177e4 266}
c5f8556c
DM
267
268/* Stop a running watchdog timer-- the timer actually keeps
269 * running, but the interrupt is masked so that no action is
270 * taken upon expiration.
1da177e4 271 */
c5f8556c 272static void cpwd_stoptimer(struct cpwd *p, int index)
1da177e4 273{
c5f8556c
DM
274 if (cpwd_readb(p->devs[index].regs + WD_STATUS) & WD_S_RUNNING) {
275 cpwd_toggleintr(p, index, WD_INTR_OFF);
1da177e4 276
c5f8556c
DM
277 if (p->broken) {
278 p->devs[index].runstatus |= WD_STAT_BSTOP;
4fa42b4e 279 cpwd_brokentimer(NULL);
c5f8556c
DM
280 }
281 }
1da177e4
LT
282}
283
c5f8556c
DM
284/* Start a watchdog timer with the specified limit value
285 * If the watchdog is running, it will be restarted with
286 * the provided limit value.
287 *
288 * This function will enable interrupts on the specified
289 * watchdog.
1da177e4 290 */
c5f8556c 291static void cpwd_starttimer(struct cpwd *p, int index)
1da177e4 292{
c5f8556c
DM
293 if (p->broken)
294 p->devs[index].runstatus &= ~WD_STAT_BSTOP;
295
296 p->devs[index].runstatus &= ~WD_STAT_SVCD;
1da177e4 297
c5f8556c
DM
298 cpwd_writew(p->devs[index].timeout, p->devs[index].regs + WD_LIMIT);
299 cpwd_toggleintr(p, index, WD_INTR_ON);
1da177e4
LT
300}
301
c5f8556c 302static int cpwd_getstatus(struct cpwd *p, int index)
1da177e4 303{
c5f8556c
DM
304 unsigned char stat = cpwd_readb(p->devs[index].regs + WD_STATUS);
305 unsigned char intr = cpwd_readb(p->devs[index].regs + PLD_IMASK);
306 unsigned char ret = WD_STOPPED;
307
308 /* determine STOPPED */
927d6961 309 if (!stat)
c5f8556c
DM
310 return ret;
311
312 /* determine EXPIRED vs FREERUN vs RUNNING */
313 else if (WD_S_EXPIRED & stat) {
314 ret = WD_EXPIRED;
927d6961 315 } else if (WD_S_RUNNING & stat) {
c5f8556c
DM
316 if (intr & p->devs[index].intr_mask) {
317 ret = WD_FREERUN;
318 } else {
319 /* Fudge WD_EXPIRED status for defective CP1400--
927d6961 320 * IF timer is running
5f3b2756
WVS
321 * AND brokenstop is set
322 * AND an interrupt has been serviced
c5f8556c
DM
323 * we are WD_EXPIRED.
324 *
927d6961 325 * IF timer is running
5f3b2756
WVS
326 * AND brokenstop is set
327 * AND no interrupt has been serviced
c5f8556c
DM
328 * we are WD_FREERUN.
329 */
330 if (p->broken &&
331 (p->devs[index].runstatus & WD_STAT_BSTOP)) {
332 if (p->devs[index].runstatus & WD_STAT_SVCD) {
333 ret = WD_EXPIRED;
334 } else {
927d6961
WVS
335 /* we could as well pretend
336 * we are expired */
c5f8556c
DM
337 ret = WD_FREERUN;
338 }
339 } else {
340 ret = WD_RUNNING;
1da177e4
LT
341 }
342 }
343 }
c5f8556c
DM
344
345 /* determine SERVICED */
346 if (p->devs[index].runstatus & WD_STAT_SVCD)
347 ret |= WD_SERVICED;
348
927d6961 349 return ret;
c5f8556c
DM
350}
351
352static irqreturn_t cpwd_interrupt(int irq, void *dev_id)
353{
354 struct cpwd *p = dev_id;
355
356 /* Only WD0 will interrupt-- others are NMI and we won't
357 * see them here....
358 */
359 spin_lock_irq(&p->lock);
360
361 cpwd_stoptimer(p, WD0_ID);
362 p->devs[WD0_ID].runstatus |= WD_STAT_SVCD;
363
364 spin_unlock_irq(&p->lock);
365
366 return IRQ_HANDLED;
1da177e4
LT
367}
368
c5f8556c 369static int cpwd_open(struct inode *inode, struct file *f)
1da177e4 370{
c5f8556c
DM
371 struct cpwd *p = cpwd_device;
372
613655fa 373 mutex_lock(&cpwd_mutex);
927d6961
WVS
374 switch (iminor(inode)) {
375 case WD0_MINOR:
376 case WD1_MINOR:
377 case WD2_MINOR:
378 break;
c5f8556c 379
927d6961 380 default:
613655fa 381 mutex_unlock(&cpwd_mutex);
927d6961 382 return -ENODEV;
1da177e4
LT
383 }
384
385 /* Register IRQ on first open of device */
c5f8556c 386 if (!p->initialized) {
927d6961 387 if (request_irq(p->irq, &cpwd_interrupt,
c5f8556c 388 IRQF_SHARED, DRIVER_NAME, p)) {
27c766aa 389 pr_err("Cannot register IRQ %d\n", p->irq);
613655fa 390 mutex_unlock(&cpwd_mutex);
c5f8556c 391 return -EBUSY;
1da177e4 392 }
c5f8556c 393 p->initialized = true;
1da177e4
LT
394 }
395
613655fa 396 mutex_unlock(&cpwd_mutex);
c5f8556c 397
c5bf68fe 398 return stream_open(inode, f);
1da177e4
LT
399}
400
c5f8556c 401static int cpwd_release(struct inode *inode, struct file *file)
1da177e4
LT
402{
403 return 0;
404}
405
9626dd75 406static long cpwd_ioctl(struct file *file, unsigned int cmd, unsigned long arg)
1da177e4 407{
42747d71 408 static const struct watchdog_info info = {
c5f8556c
DM
409 .options = WDIOF_SETTIMEOUT,
410 .firmware_version = 1,
411 .identity = DRIVER_NAME,
1da177e4 412 };
c5f8556c 413 void __user *argp = (void __user *)arg;
496ad9aa 414 struct inode *inode = file_inode(file);
c5f8556c
DM
415 int index = iminor(inode) - WD0_MINOR;
416 struct cpwd *p = cpwd_device;
417 int setopt = 0;
1da177e4 418
c5f8556c
DM
419 switch (cmd) {
420 /* Generic Linux IOCTLs */
421 case WDIOC_GETSUPPORT:
422 if (copy_to_user(argp, &info, sizeof(struct watchdog_info)))
423 return -EFAULT;
424 break;
1da177e4 425
c5f8556c
DM
426 case WDIOC_GETSTATUS:
427 case WDIOC_GETBOOTSTATUS:
428 if (put_user(0, (int __user *)argp))
429 return -EFAULT;
430 break;
431
432 case WDIOC_KEEPALIVE:
433 cpwd_pingtimer(p, index);
434 break;
435
436 case WDIOC_SETOPTIONS:
437 if (copy_from_user(&setopt, argp, sizeof(unsigned int)))
438 return -EFAULT;
439
440 if (setopt & WDIOS_DISABLECARD) {
441 if (p->enabled)
442 return -EINVAL;
443 cpwd_stoptimer(p, index);
444 } else if (setopt & WDIOS_ENABLECARD) {
445 cpwd_starttimer(p, index);
446 } else {
447 return -EINVAL;
927d6961 448 }
c5f8556c
DM
449 break;
450
451 /* Solaris-compatible IOCTLs */
452 case WIOCGSTAT:
453 setopt = cpwd_getstatus(p, index);
454 if (copy_to_user(argp, &setopt, sizeof(unsigned int)))
455 return -EFAULT;
456 break;
457
458 case WIOCSTART:
459 cpwd_starttimer(p, index);
460 break;
461
462 case WIOCSTOP:
463 if (p->enabled)
927d6961 464 return -EINVAL;
c5f8556c
DM
465
466 cpwd_stoptimer(p, index);
467 break;
468
469 default:
470 return -EINVAL;
1da177e4 471 }
c5f8556c
DM
472
473 return 0;
1da177e4
LT
474}
475
c5f8556c
DM
476static long cpwd_compat_ioctl(struct file *file, unsigned int cmd,
477 unsigned long arg)
b66621fe
CH
478{
479 int rval = -ENOIOCTLCMD;
480
481 switch (cmd) {
482 /* solaris ioctls are specific to this driver */
483 case WIOCSTART:
484 case WIOCSTOP:
485 case WIOCGSTAT:
613655fa 486 mutex_lock(&cpwd_mutex);
9626dd75 487 rval = cpwd_ioctl(file, cmd, arg);
613655fa 488 mutex_unlock(&cpwd_mutex);
b66621fe 489 break;
c5f8556c 490
b66621fe
CH
491 /* everything else is handled by the generic compat layer */
492 default:
493 break;
494 }
495
496 return rval;
497}
498
927d6961 499static ssize_t cpwd_write(struct file *file, const char __user *buf,
c5f8556c 500 size_t count, loff_t *ppos)
1da177e4 501{
496ad9aa 502 struct inode *inode = file_inode(file);
c5f8556c
DM
503 struct cpwd *p = cpwd_device;
504 int index = iminor(inode);
1da177e4
LT
505
506 if (count) {
c5f8556c 507 cpwd_pingtimer(p, index);
1da177e4
LT
508 return 1;
509 }
1da177e4 510
c5f8556c 511 return 0;
1da177e4
LT
512}
513
927d6961 514static ssize_t cpwd_read(struct file *file, char __user *buffer,
c5f8556c 515 size_t count, loff_t *ppos)
1da177e4 516{
c5f8556c 517 return -EINVAL;
1da177e4
LT
518}
519
c5f8556c 520static const struct file_operations cpwd_fops = {
9626dd75
WVS
521 .owner = THIS_MODULE,
522 .unlocked_ioctl = cpwd_ioctl,
523 .compat_ioctl = cpwd_compat_ioctl,
524 .open = cpwd_open,
525 .write = cpwd_write,
526 .read = cpwd_read,
527 .release = cpwd_release,
6038f373 528 .llseek = no_llseek,
1da177e4
LT
529};
530
2d991a16 531static int cpwd_probe(struct platform_device *op)
1da177e4 532{
c5f8556c
DM
533 struct device_node *options;
534 const char *str_prop;
535 const void *prop_val;
536 int i, err = -EINVAL;
537 struct cpwd *p;
1da177e4 538
c5f8556c
DM
539 if (cpwd_device)
540 return -EINVAL;
1da177e4 541
b6621df5
AK
542 p = devm_kzalloc(&op->dev, sizeof(*p), GFP_KERNEL);
543 if (!p)
544 return -ENOMEM;
1da177e4 545
1636f8ac 546 p->irq = op->archdata.irqs[0];
1da177e4 547
c5f8556c 548 spin_lock_init(&p->lock);
1da177e4 549
c5f8556c
DM
550 p->regs = of_ioremap(&op->resource[0], 0,
551 4 * WD_TIMER_REGSZ, DRIVER_NAME);
552 if (!p->regs) {
27c766aa 553 pr_err("Unable to map registers\n");
b6621df5 554 return -ENOMEM;
1da177e4 555 }
1da177e4 556
c5f8556c 557 options = of_find_node_by_path("/options");
c5f8556c 558 if (!options) {
b6621df5 559 err = -ENODEV;
27c766aa 560 pr_err("Unable to find /options node\n");
c5f8556c
DM
561 goto out_iounmap;
562 }
1da177e4 563
c5f8556c
DM
564 prop_val = of_get_property(options, "watchdog-enable?", NULL);
565 p->enabled = (prop_val ? true : false);
1da177e4 566
c5f8556c
DM
567 prop_val = of_get_property(options, "watchdog-reboot?", NULL);
568 p->reboot = (prop_val ? true : false);
1da177e4 569
c5f8556c
DM
570 str_prop = of_get_property(options, "watchdog-timeout", NULL);
571 if (str_prop)
572 p->timeout = simple_strtoul(str_prop, NULL, 10);
1da177e4 573
06f8f2ca
YL
574 of_node_put(options);
575
c5f8556c
DM
576 /* CP1400s seem to have broken PLD implementations-- the
577 * interrupt_mask register cannot be written, so no timer
578 * interrupts can be masked within the PLD.
1da177e4 579 */
61c7a080 580 str_prop = of_get_property(op->dev.of_node, "model", NULL);
c5f8556c
DM
581 p->broken = (str_prop && !strcmp(str_prop, WD_BADMODEL));
582
583 if (!p->enabled)
584 cpwd_toggleintr(p, -1, WD_INTR_OFF);
585
586 for (i = 0; i < WD_NUMDEVS; i++) {
587 static const char *cpwd_names[] = { "RIC", "XIR", "POR" };
588 static int *parms[] = { &wd0_timeout,
589 &wd1_timeout,
590 &wd2_timeout };
591 struct miscdevice *mp = &p->devs[i].misc;
592
593 mp->minor = WD0_MINOR + i;
594 mp->name = cpwd_names[i];
595 mp->fops = &cpwd_fops;
596
597 p->devs[i].regs = p->regs + (i * WD_TIMER_REGSZ);
598 p->devs[i].intr_mask = (WD0_INTR_MASK << i);
599 p->devs[i].runstatus &= ~WD_STAT_BSTOP;
600 p->devs[i].runstatus |= WD_STAT_INIT;
601 p->devs[i].timeout = p->timeout;
602 if (*parms[i])
603 p->devs[i].timeout = *parms[i];
604
605 err = misc_register(&p->devs[i].misc);
606 if (err) {
27c766aa
JP
607 pr_err("Could not register misc device for dev %d\n",
608 i);
c5f8556c 609 goto out_unregister;
1da177e4
LT
610 }
611 }
612
c5f8556c 613 if (p->broken) {
4fa42b4e 614 timer_setup(&cpwd_timer, cpwd_brokentimer, 0);
c5f8556c
DM
615 cpwd_timer.expires = WD_BTIMEOUT;
616
27c766aa
JP
617 pr_info("PLD defect workaround enabled for model %s\n",
618 WD_BADMODEL);
1da177e4 619 }
1da177e4 620
26556b6e 621 platform_set_drvdata(op, p);
c5f8556c 622 cpwd_device = p;
b6621df5 623 return 0;
1da177e4 624
c5f8556c
DM
625out_unregister:
626 for (i--; i >= 0; i--)
627 misc_deregister(&p->devs[i].misc);
1da177e4 628
c5f8556c
DM
629out_iounmap:
630 of_iounmap(&op->resource[0], p->regs, 4 * WD_TIMER_REGSZ);
631
b6621df5 632 return err;
1da177e4
LT
633}
634
4b12b896 635static int cpwd_remove(struct platform_device *op)
1da177e4 636{
26556b6e 637 struct cpwd *p = platform_get_drvdata(op);
c5f8556c
DM
638 int i;
639
bbd562d7 640 for (i = 0; i < WD_NUMDEVS; i++) {
c5f8556c
DM
641 misc_deregister(&p->devs[i].misc);
642
643 if (!p->enabled) {
644 cpwd_stoptimer(p, i);
645 if (p->devs[i].runstatus & WD_STAT_BSTOP)
646 cpwd_resetbrokentimer(p, i);
1da177e4
LT
647 }
648 }
649
c5f8556c
DM
650 if (p->broken)
651 del_timer_sync(&cpwd_timer);
1da177e4 652
c5f8556c
DM
653 if (p->initialized)
654 free_irq(p->irq, p);
1da177e4 655
c5f8556c 656 of_iounmap(&op->resource[0], p->regs, 4 * WD_TIMER_REGSZ);
1da177e4 657
c5f8556c 658 cpwd_device = NULL;
1da177e4 659
c5f8556c
DM
660 return 0;
661}
1da177e4 662
fd098316 663static const struct of_device_id cpwd_match[] = {
c5f8556c
DM
664 {
665 .name = "watchdog",
666 },
667 {},
668};
669MODULE_DEVICE_TABLE(of, cpwd_match);
1da177e4 670
1c48a5c9 671static struct platform_driver cpwd_driver = {
4018294b
GL
672 .driver = {
673 .name = DRIVER_NAME,
4018294b
GL
674 .of_match_table = cpwd_match,
675 },
c5f8556c 676 .probe = cpwd_probe,
82268714 677 .remove = cpwd_remove,
c5f8556c 678};
1da177e4 679
b8ec6118 680module_platform_driver(cpwd_driver);