V4L/DVB (10003): m5602: Simplify the error handling in the ov9650 sensor
[linux-2.6] / drivers / watchdog / bfin_wdt.c
1 /*
2  * Blackfin On-Chip Watchdog Driver
3  *  Supports BF53[123]/BF53[467]/BF54[2489]/BF561
4  *
5  * Originally based on softdog.c
6  * Copyright 2006-2007 Analog Devices Inc.
7  * Copyright 2006-2007 Michele d'Amico
8  * Copyright 1996 Alan Cox <alan@lxorguk.ukuu.org.uk>
9  *
10  * Enter bugs at http://blackfin.uclinux.org/
11  *
12  * Licensed under the GPL-2 or later.
13  */
14
15 #include <linux/platform_device.h>
16 #include <linux/module.h>
17 #include <linux/moduleparam.h>
18 #include <linux/types.h>
19 #include <linux/timer.h>
20 #include <linux/miscdevice.h>
21 #include <linux/watchdog.h>
22 #include <linux/fs.h>
23 #include <linux/notifier.h>
24 #include <linux/reboot.h>
25 #include <linux/init.h>
26 #include <linux/interrupt.h>
27 #include <linux/uaccess.h>
28 #include <asm/blackfin.h>
29
30 #define stamp(fmt, args...) pr_debug("%s:%i: " fmt "\n", __func__, __LINE__, ## args)
31 #define stampit() stamp("here i am")
32 #define pr_devinit(fmt, args...) ({ static const __devinitconst char __fmt[] = fmt; printk(__fmt, ## args); })
33 #define pr_init(fmt, args...) ({ static const __initconst char __fmt[] = fmt; printk(__fmt, ## args); })
34
35 #define WATCHDOG_NAME "bfin-wdt"
36 #define PFX WATCHDOG_NAME ": "
37
38 /* The BF561 has two watchdogs (one per core), but since Linux
39  * only runs on core A, we'll just work with that one.
40  */
41 #ifdef BF561_FAMILY
42 # define bfin_read_WDOG_CTL()    bfin_read_WDOGA_CTL()
43 # define bfin_read_WDOG_CNT()    bfin_read_WDOGA_CNT()
44 # define bfin_read_WDOG_STAT()   bfin_read_WDOGA_STAT()
45 # define bfin_write_WDOG_CTL(x)  bfin_write_WDOGA_CTL(x)
46 # define bfin_write_WDOG_CNT(x)  bfin_write_WDOGA_CNT(x)
47 # define bfin_write_WDOG_STAT(x) bfin_write_WDOGA_STAT(x)
48 #endif
49
50 /* Bit in SWRST that indicates boot caused by watchdog */
51 #define SWRST_RESET_WDOG 0x4000
52
53 /* Bit in WDOG_CTL that indicates watchdog has expired (WDR0) */
54 #define WDOG_EXPIRED 0x8000
55
56 /* Masks for WDEV field in WDOG_CTL register */
57 #define ICTL_RESET   0x0
58 #define ICTL_NMI     0x2
59 #define ICTL_GPI     0x4
60 #define ICTL_NONE    0x6
61 #define ICTL_MASK    0x6
62
63 /* Masks for WDEN field in WDOG_CTL register */
64 #define WDEN_MASK    0x0FF0
65 #define WDEN_ENABLE  0x0000
66 #define WDEN_DISABLE 0x0AD0
67
68 /* some defaults */
69 #define WATCHDOG_TIMEOUT 20
70
71 static unsigned int timeout = WATCHDOG_TIMEOUT;
72 static int nowayout = WATCHDOG_NOWAYOUT;
73 static struct watchdog_info bfin_wdt_info;
74 static unsigned long open_check;
75 static char expect_close;
76 static DEFINE_SPINLOCK(bfin_wdt_spinlock);
77
78 /**
79  *      bfin_wdt_keepalive - Keep the Userspace Watchdog Alive
80  *
81  *      The Userspace watchdog got a KeepAlive: schedule the next timeout.
82  */
83 static int bfin_wdt_keepalive(void)
84 {
85         stampit();
86         bfin_write_WDOG_STAT(0);
87         return 0;
88 }
89
90 /**
91  *      bfin_wdt_stop - Stop the Watchdog
92  *
93  *      Stops the on-chip watchdog.
94  */
95 static int bfin_wdt_stop(void)
96 {
97         stampit();
98         bfin_write_WDOG_CTL(WDEN_DISABLE);
99         return 0;
100 }
101
102 /**
103  *      bfin_wdt_start - Start the Watchdog
104  *
105  *      Starts the on-chip watchdog.  Automatically loads WDOG_CNT
106  *      into WDOG_STAT for us.
107  */
108 static int bfin_wdt_start(void)
109 {
110         stampit();
111         bfin_write_WDOG_CTL(WDEN_ENABLE | ICTL_RESET);
112         return 0;
113 }
114
115 /**
116  *      bfin_wdt_running - Check Watchdog status
117  *
118  *      See if the watchdog is running.
119  */
120 static int bfin_wdt_running(void)
121 {
122         stampit();
123         return ((bfin_read_WDOG_CTL() & WDEN_MASK) != WDEN_DISABLE);
124 }
125
126 /**
127  *      bfin_wdt_set_timeout - Set the Userspace Watchdog timeout
128  *      @t: new timeout value (in seconds)
129  *
130  *      Translate the specified timeout in seconds into System Clock
131  *      terms which is what the on-chip Watchdog requires.
132  */
133 static int bfin_wdt_set_timeout(unsigned long t)
134 {
135         u32 cnt;
136         unsigned long flags;
137
138         stampit();
139
140         cnt = t * get_sclk();
141         if (cnt < get_sclk()) {
142                 printk(KERN_WARNING PFX "timeout value is too large\n");
143                 return -EINVAL;
144         }
145
146         spin_lock_irqsave(&bfin_wdt_spinlock, flags);
147         {
148                 int run = bfin_wdt_running();
149                 bfin_wdt_stop();
150                 bfin_write_WDOG_CNT(cnt);
151                 if (run)
152                         bfin_wdt_start();
153         }
154         spin_unlock_irqrestore(&bfin_wdt_spinlock, flags);
155
156         timeout = t;
157
158         return 0;
159 }
160
161 /**
162  *      bfin_wdt_open - Open the Device
163  *      @inode: inode of device
164  *      @file: file handle of device
165  *
166  *      Watchdog device is opened and started.
167  */
168 static int bfin_wdt_open(struct inode *inode, struct file *file)
169 {
170         stampit();
171
172         if (test_and_set_bit(0, &open_check))
173                 return -EBUSY;
174
175         if (nowayout)
176                 __module_get(THIS_MODULE);
177
178         bfin_wdt_keepalive();
179         bfin_wdt_start();
180
181         return nonseekable_open(inode, file);
182 }
183
184 /**
185  *      bfin_wdt_close - Close the Device
186  *      @inode: inode of device
187  *      @file: file handle of device
188  *
189  *      Watchdog device is closed and stopped.
190  */
191 static int bfin_wdt_release(struct inode *inode, struct file *file)
192 {
193         stampit();
194
195         if (expect_close == 42)
196                 bfin_wdt_stop();
197         else {
198                 printk(KERN_CRIT PFX
199                         "Unexpected close, not stopping watchdog!\n");
200                 bfin_wdt_keepalive();
201         }
202         expect_close = 0;
203         clear_bit(0, &open_check);
204         return 0;
205 }
206
207 /**
208  *      bfin_wdt_write - Write to Device
209  *      @file: file handle of device
210  *      @buf: buffer to write
211  *      @count: length of buffer
212  *      @ppos: offset
213  *
214  *      Pings the watchdog on write.
215  */
216 static ssize_t bfin_wdt_write(struct file *file, const char __user *data,
217                                                 size_t len, loff_t *ppos)
218 {
219         stampit();
220
221         if (len) {
222                 if (!nowayout) {
223                         size_t i;
224
225                         /* In case it was set long ago */
226                         expect_close = 0;
227
228                         for (i = 0; i != len; i++) {
229                                 char c;
230                                 if (get_user(c, data + i))
231                                         return -EFAULT;
232                                 if (c == 'V')
233                                         expect_close = 42;
234                         }
235                 }
236                 bfin_wdt_keepalive();
237         }
238
239         return len;
240 }
241
242 /**
243  *      bfin_wdt_ioctl - Query Device
244  *      @file: file handle of device
245  *      @cmd: watchdog command
246  *      @arg: argument
247  *
248  *      Query basic information from the device or ping it, as outlined by the
249  *      watchdog API.
250  */
251 static long bfin_wdt_ioctl(struct file *file,
252                                 unsigned int cmd, unsigned long arg)
253 {
254         void __user *argp = (void __user *)arg;
255         int __user *p = argp;
256
257         stampit();
258
259         switch (cmd) {
260         case WDIOC_GETSUPPORT:
261                 if (copy_to_user(argp, &bfin_wdt_info, sizeof(bfin_wdt_info)))
262                         return -EFAULT;
263                 else
264                         return 0;
265         case WDIOC_GETSTATUS:
266         case WDIOC_GETBOOTSTATUS:
267                 return put_user(!!(_bfin_swrst & SWRST_RESET_WDOG), p);
268         case WDIOC_SETOPTIONS: {
269                 unsigned long flags;
270                 int options, ret = -EINVAL;
271
272                 if (get_user(options, p))
273                         return -EFAULT;
274
275                 spin_lock_irqsave(&bfin_wdt_spinlock, flags);
276                 if (options & WDIOS_DISABLECARD) {
277                         bfin_wdt_stop();
278                         ret = 0;
279                 }
280                 if (options & WDIOS_ENABLECARD) {
281                         bfin_wdt_start();
282                         ret = 0;
283                 }
284                 spin_unlock_irqrestore(&bfin_wdt_spinlock, flags);
285                 return ret;
286         }
287         case WDIOC_KEEPALIVE:
288                 bfin_wdt_keepalive();
289                 return 0;
290         case WDIOC_SETTIMEOUT: {
291                 int new_timeout;
292
293                 if (get_user(new_timeout, p))
294                         return -EFAULT;
295                 if (bfin_wdt_set_timeout(new_timeout))
296                         return -EINVAL;
297         }
298         /* Fall */
299         case WDIOC_GETTIMEOUT:
300                 return put_user(timeout, p);
301         default:
302                 return -ENOTTY;
303         }
304 }
305
306 /**
307  *      bfin_wdt_notify_sys - Notifier Handler
308  *      @this: notifier block
309  *      @code: notifier event
310  *      @unused: unused
311  *
312  *      Handles specific events, such as turning off the watchdog during a
313  *      shutdown event.
314  */
315 static int bfin_wdt_notify_sys(struct notifier_block *this,
316                                         unsigned long code, void *unused)
317 {
318         stampit();
319
320         if (code == SYS_DOWN || code == SYS_HALT)
321                 bfin_wdt_stop();
322
323         return NOTIFY_DONE;
324 }
325
326 #ifdef CONFIG_PM
327 static int state_before_suspend;
328
329 /**
330  *      bfin_wdt_suspend - suspend the watchdog
331  *      @pdev: device being suspended
332  *      @state: requested suspend state
333  *
334  *      Remember if the watchdog was running and stop it.
335  *      TODO: is this even right?  Doesn't seem to be any
336  *            standard in the watchdog world ...
337  */
338 static int bfin_wdt_suspend(struct platform_device *pdev, pm_message_t state)
339 {
340         stampit();
341
342         state_before_suspend = bfin_wdt_running();
343         bfin_wdt_stop();
344
345         return 0;
346 }
347
348 /**
349  *      bfin_wdt_resume - resume the watchdog
350  *      @pdev: device being resumed
351  *
352  *      If the watchdog was running, turn it back on.
353  */
354 static int bfin_wdt_resume(struct platform_device *pdev)
355 {
356         stampit();
357
358         if (state_before_suspend) {
359                 bfin_wdt_set_timeout(timeout);
360                 bfin_wdt_start();
361         }
362
363         return 0;
364 }
365 #else
366 # define bfin_wdt_suspend NULL
367 # define bfin_wdt_resume NULL
368 #endif
369
370 static const struct file_operations bfin_wdt_fops = {
371         .owner          = THIS_MODULE,
372         .llseek         = no_llseek,
373         .write          = bfin_wdt_write,
374         .unlocked_ioctl = bfin_wdt_ioctl,
375         .open           = bfin_wdt_open,
376         .release        = bfin_wdt_release,
377 };
378
379 static struct miscdevice bfin_wdt_miscdev = {
380         .minor    = WATCHDOG_MINOR,
381         .name     = "watchdog",
382         .fops     = &bfin_wdt_fops,
383 };
384
385 static struct watchdog_info bfin_wdt_info = {
386         .identity = "Blackfin Watchdog",
387         .options  = WDIOF_SETTIMEOUT |
388                     WDIOF_KEEPALIVEPING |
389                     WDIOF_MAGICCLOSE,
390 };
391
392 static struct notifier_block bfin_wdt_notifier = {
393         .notifier_call = bfin_wdt_notify_sys,
394 };
395
396 /**
397  *      bfin_wdt_probe - Initialize module
398  *
399  *      Registers the misc device and notifier handler.  Actual device
400  *      initialization is handled by bfin_wdt_open().
401  */
402 static int __devinit bfin_wdt_probe(struct platform_device *pdev)
403 {
404         int ret;
405
406         ret = register_reboot_notifier(&bfin_wdt_notifier);
407         if (ret) {
408                 pr_devinit(KERN_ERR PFX
409                         "cannot register reboot notifier (err=%d)\n", ret);
410                 return ret;
411         }
412
413         ret = misc_register(&bfin_wdt_miscdev);
414         if (ret) {
415                 pr_devinit(KERN_ERR PFX
416                         "cannot register miscdev on minor=%d (err=%d)\n",
417                                 WATCHDOG_MINOR, ret);
418                 unregister_reboot_notifier(&bfin_wdt_notifier);
419                 return ret;
420         }
421
422         pr_devinit(KERN_INFO PFX "initialized: timeout=%d sec (nowayout=%d)\n",
423                timeout, nowayout);
424
425         return 0;
426 }
427
428 /**
429  *      bfin_wdt_remove - Initialize module
430  *
431  *      Unregisters the misc device and notifier handler.  Actual device
432  *      deinitialization is handled by bfin_wdt_close().
433  */
434 static int __devexit bfin_wdt_remove(struct platform_device *pdev)
435 {
436         misc_deregister(&bfin_wdt_miscdev);
437         unregister_reboot_notifier(&bfin_wdt_notifier);
438         return 0;
439 }
440
441 static struct platform_device *bfin_wdt_device;
442
443 static struct platform_driver bfin_wdt_driver = {
444         .probe     = bfin_wdt_probe,
445         .remove    = __devexit_p(bfin_wdt_remove),
446         .suspend   = bfin_wdt_suspend,
447         .resume    = bfin_wdt_resume,
448         .driver    = {
449                 .name  = WATCHDOG_NAME,
450                 .owner = THIS_MODULE,
451         },
452 };
453
454 /**
455  *      bfin_wdt_init - Initialize module
456  *
457  *      Checks the module params and registers the platform device & driver.
458  *      Real work is in the platform probe function.
459  */
460 static int __init bfin_wdt_init(void)
461 {
462         int ret;
463
464         stampit();
465
466         /* Check that the timeout value is within range */
467         if (bfin_wdt_set_timeout(timeout))
468                 return -EINVAL;
469
470         /* Since this is an on-chip device and needs no board-specific
471          * resources, we'll handle all the platform device stuff here.
472          */
473         ret = platform_driver_register(&bfin_wdt_driver);
474         if (ret) {
475                 pr_init(KERN_ERR PFX "unable to register driver\n");
476                 return ret;
477         }
478
479         bfin_wdt_device = platform_device_register_simple(WATCHDOG_NAME, -1, NULL, 0);
480         if (IS_ERR(bfin_wdt_device)) {
481                 pr_init(KERN_ERR PFX "unable to register device\n");
482                 platform_driver_unregister(&bfin_wdt_driver);
483                 return PTR_ERR(bfin_wdt_device);
484         }
485
486         return 0;
487 }
488
489 /**
490  *      bfin_wdt_exit - Deinitialize module
491  *
492  *      Back out the platform device & driver steps.  Real work is in the
493  *      platform remove function.
494  */
495 static void __exit bfin_wdt_exit(void)
496 {
497         platform_device_unregister(bfin_wdt_device);
498         platform_driver_unregister(&bfin_wdt_driver);
499 }
500
501 module_init(bfin_wdt_init);
502 module_exit(bfin_wdt_exit);
503
504 MODULE_AUTHOR("Michele d'Amico, Mike Frysinger <vapier@gentoo.org>");
505 MODULE_DESCRIPTION("Blackfin Watchdog Device Driver");
506 MODULE_LICENSE("GPL");
507 MODULE_ALIAS_MISCDEV(WATCHDOG_MINOR);
508
509 module_param(timeout, uint, 0);
510 MODULE_PARM_DESC(timeout,
511         "Watchdog timeout in seconds. (1<=timeout<=((2^32)/SCLK), default="
512                 __MODULE_STRING(WATCHDOG_TIMEOUT) ")");
513
514 module_param(nowayout, int, 0);
515 MODULE_PARM_DESC(nowayout,
516         "Watchdog cannot be stopped once started (default="
517                 __MODULE_STRING(WATCHDOG_NOWAYOUT) ")");