Blame view
drivers/watchdog/pnx4008_wdt.c
8.49 KB
9325fa361 [WATCHDOG] pnx400... |
1 2 3 4 5 6 |
/* * drivers/char/watchdog/pnx4008_wdt.c * * Watchdog driver for PNX4008 board * * Authors: Dmitry Chigirev <source@mvista.com>, |
5f3b27569 watchdog: cleanup... |
7 |
* Vitaly Wool <vitalywool@gmail.com> |
9325fa361 [WATCHDOG] pnx400... |
8 9 10 11 12 13 14 15 |
* Based on sa1100 driver, * Copyright (C) 2000 Oleg Drokin <green@crimea.edu> * * 2005-2006 (c) MontaVista Software, Inc. This file is licensed under * the terms of the GNU General Public License version 2. This program * is licensed "as is" without any warranty of any kind, whether express * or implied. */ |
9325fa361 [WATCHDOG] pnx400... |
16 17 18 19 20 21 22 23 24 25 26 27 28 |
#include <linux/module.h> #include <linux/moduleparam.h> #include <linux/types.h> #include <linux/kernel.h> #include <linux/fs.h> #include <linux/miscdevice.h> #include <linux/watchdog.h> #include <linux/init.h> #include <linux/bitops.h> #include <linux/ioport.h> #include <linux/device.h> #include <linux/platform_device.h> #include <linux/clk.h> |
99d2853ac [WATCHDOG] pnx400... |
29 |
#include <linux/spinlock.h> |
84ca995c2 [WATCHDOG 33/57] ... |
30 31 |
#include <linux/uaccess.h> #include <linux/io.h> |
5a0e3ad6a include cleanup: ... |
32 |
#include <linux/slab.h> |
a09e64fbc [ARM] Move includ... |
33 |
#include <mach/hardware.h> |
9325fa361 [WATCHDOG] pnx400... |
34 35 36 37 38 39 40 41 42 43 44 45 46 47 48 49 50 51 52 53 54 55 56 |
#define MODULE_NAME "PNX4008-WDT: " /* WatchDog Timer - Chapter 23 Page 207 */ #define DEFAULT_HEARTBEAT 19 #define MAX_HEARTBEAT 60 /* Watchdog timer register set definition */ #define WDTIM_INT(p) ((p) + 0x0) #define WDTIM_CTRL(p) ((p) + 0x4) #define WDTIM_COUNTER(p) ((p) + 0x8) #define WDTIM_MCTRL(p) ((p) + 0xC) #define WDTIM_MATCH0(p) ((p) + 0x10) #define WDTIM_EMR(p) ((p) + 0x14) #define WDTIM_PULSE(p) ((p) + 0x18) #define WDTIM_RES(p) ((p) + 0x1C) /* WDTIM_INT bit definitions */ #define MATCH_INT 1 /* WDTIM_CTRL bit definitions */ #define COUNT_ENAB 1 |
143a2e54b [WATCHDOG] More c... |
57 58 |
#define RESET_COUNT (1 << 1) #define DEBUG_EN (1 << 2) |
9325fa361 [WATCHDOG] pnx400... |
59 60 61 62 |
/* WDTIM_MCTRL bit definitions */ #define MR0_INT 1 #undef RESET_COUNT0 |
143a2e54b [WATCHDOG] More c... |
63 64 65 66 67 68 |
#define RESET_COUNT0 (1 << 2) #define STOP_COUNT0 (1 << 2) #define M_RES1 (1 << 3) #define M_RES2 (1 << 4) #define RESFRC1 (1 << 5) #define RESFRC2 (1 << 6) |
9325fa361 [WATCHDOG] pnx400... |
69 70 71 |
/* WDTIM_EMR bit definitions */ #define EXT_MATCH0 1 |
143a2e54b [WATCHDOG] More c... |
72 |
#define MATCH_OUTPUT_HIGH (2 << 4) /*a MATCH_CTRL setting */ |
9325fa361 [WATCHDOG] pnx400... |
73 74 75 76 77 |
/* WDTIM_RES bit definitions */ #define WDOG_RESET 1 /* read only */ #define WDOG_COUNTER_RATE 13000000 /*the counter clock is 13 MHz fixed */ |
289817270 [WATCHDOG] pnx400... |
78 |
static int nowayout = WATCHDOG_NOWAYOUT; |
9325fa361 [WATCHDOG] pnx400... |
79 |
static int heartbeat = DEFAULT_HEARTBEAT; |
c7dfd0cca [WATCHDOG] spin_l... |
80 |
static DEFINE_SPINLOCK(io_lock); |
9325fa361 [WATCHDOG] pnx400... |
81 82 83 84 85 86 87 88 89 90 91 92 93 94 |
static unsigned long wdt_status; #define WDT_IN_USE 0 #define WDT_OK_TO_CLOSE 1 #define WDT_REGION_INITED 2 #define WDT_DEVICE_INITED 3 static unsigned long boot_status; static struct resource *wdt_mem; static void __iomem *wdt_base; struct clk *wdt_clk; static void wdt_enable(void) { |
99d2853ac [WATCHDOG] pnx400... |
95 |
spin_lock(&io_lock); |
9325fa361 [WATCHDOG] pnx400... |
96 97 98 |
/* stop counter, initiate counter reset */ __raw_writel(RESET_COUNT, WDTIM_CTRL(wdt_base)); /*wait for reset to complete. 100% guarantee event */ |
65a64ec3b [WATCHDOG] pnx400... |
99 100 |
while (__raw_readl(WDTIM_COUNTER(wdt_base))) cpu_relax(); |
9325fa361 [WATCHDOG] pnx400... |
101 102 103 104 105 106 107 108 109 110 111 112 |
/* internal and external reset, stop after that */ __raw_writel(M_RES2 | STOP_COUNT0 | RESET_COUNT0, WDTIM_MCTRL(wdt_base)); /* configure match output */ __raw_writel(MATCH_OUTPUT_HIGH, WDTIM_EMR(wdt_base)); /* clear interrupt, just in case */ __raw_writel(MATCH_INT, WDTIM_INT(wdt_base)); /* the longest pulse period 65541/(13*10^6) seconds ~ 5 ms. */ __raw_writel(0xFFFF, WDTIM_PULSE(wdt_base)); __raw_writel(heartbeat * WDOG_COUNTER_RATE, WDTIM_MATCH0(wdt_base)); /*enable counter, stop when debugger active */ __raw_writel(COUNT_ENAB | DEBUG_EN, WDTIM_CTRL(wdt_base)); |
99d2853ac [WATCHDOG] pnx400... |
113 114 |
spin_unlock(&io_lock); |
9325fa361 [WATCHDOG] pnx400... |
115 116 117 118 |
} static void wdt_disable(void) { |
99d2853ac [WATCHDOG] pnx400... |
119 |
spin_lock(&io_lock); |
9325fa361 [WATCHDOG] pnx400... |
120 |
__raw_writel(0, WDTIM_CTRL(wdt_base)); /*stop counter */ |
99d2853ac [WATCHDOG] pnx400... |
121 122 |
spin_unlock(&io_lock); |
9325fa361 [WATCHDOG] pnx400... |
123 124 125 126 |
} static int pnx4008_wdt_open(struct inode *inode, struct file *file) { |
24fd1edaa ARM: PNX4008: con... |
127 |
int ret; |
9325fa361 [WATCHDOG] pnx400... |
128 129 130 131 |
if (test_and_set_bit(WDT_IN_USE, &wdt_status)) return -EBUSY; clear_bit(WDT_OK_TO_CLOSE, &wdt_status); |
24fd1edaa ARM: PNX4008: con... |
132 133 134 135 136 |
ret = clk_enable(wdt_clk); if (ret) { clear_bit(WDT_IN_USE, &wdt_status); return ret; } |
9325fa361 [WATCHDOG] pnx400... |
137 138 139 140 |
wdt_enable(); return nonseekable_open(inode, file); } |
84ca995c2 [WATCHDOG 33/57] ... |
141 142 |
static ssize_t pnx4008_wdt_write(struct file *file, const char *data, size_t len, loff_t *ppos) |
9325fa361 [WATCHDOG] pnx400... |
143 |
{ |
9325fa361 [WATCHDOG] pnx400... |
144 145 146 147 148 149 150 151 152 153 154 155 156 157 158 159 160 161 162 163 |
if (len) { if (!nowayout) { size_t i; clear_bit(WDT_OK_TO_CLOSE, &wdt_status); for (i = 0; i != len; i++) { char c; if (get_user(c, data + i)) return -EFAULT; if (c == 'V') set_bit(WDT_OK_TO_CLOSE, &wdt_status); } } wdt_enable(); } return len; } |
84ca995c2 [WATCHDOG 33/57] ... |
164 |
static const struct watchdog_info ident = { |
9325fa361 [WATCHDOG] pnx400... |
165 166 167 168 |
.options = WDIOF_CARDRESET | WDIOF_MAGICCLOSE | WDIOF_SETTIMEOUT | WDIOF_KEEPALIVEPING, .identity = "PNX4008 Watchdog", }; |
7275fc8c3 [WATCHDOG] unlock... |
169 170 |
static long pnx4008_wdt_ioctl(struct file *file, unsigned int cmd, unsigned long arg) |
9325fa361 [WATCHDOG] pnx400... |
171 |
{ |
f311896a9 [WATCHDOG] use EN... |
172 |
int ret = -ENOTTY; |
9325fa361 [WATCHDOG] pnx400... |
173 174 175 176 177 178 179 180 181 182 183 184 185 186 187 |
int time; switch (cmd) { case WDIOC_GETSUPPORT: ret = copy_to_user((struct watchdog_info *)arg, &ident, sizeof(ident)) ? -EFAULT : 0; break; case WDIOC_GETSTATUS: ret = put_user(0, (int *)arg); break; case WDIOC_GETBOOTSTATUS: ret = put_user(boot_status, (int *)arg); break; |
0c06090c9 [WATCHDOG] Coding... |
188 189 190 191 |
case WDIOC_KEEPALIVE: wdt_enable(); ret = 0; break; |
9325fa361 [WATCHDOG] pnx400... |
192 193 194 195 196 197 198 199 200 201 202 203 204 205 206 207 208 |
case WDIOC_SETTIMEOUT: ret = get_user(time, (int *)arg); if (ret) break; if (time <= 0 || time > MAX_HEARTBEAT) { ret = -EINVAL; break; } heartbeat = time; wdt_enable(); /* Fall through */ case WDIOC_GETTIMEOUT: ret = put_user(heartbeat, (int *)arg); break; |
9325fa361 [WATCHDOG] pnx400... |
209 210 211 212 213 214 215 216 217 218 219 |
} return ret; } static int pnx4008_wdt_release(struct inode *inode, struct file *file) { if (!test_bit(WDT_OK_TO_CLOSE, &wdt_status)) printk(KERN_WARNING "WATCHDOG: Device closed unexpectdly "); wdt_disable(); |
24fd1edaa ARM: PNX4008: con... |
220 |
clk_disable(wdt_clk); |
9325fa361 [WATCHDOG] pnx400... |
221 222 223 224 225 |
clear_bit(WDT_IN_USE, &wdt_status); clear_bit(WDT_OK_TO_CLOSE, &wdt_status); return 0; } |
2b8693c06 [PATCH] mark stru... |
226 |
static const struct file_operations pnx4008_wdt_fops = { |
9325fa361 [WATCHDOG] pnx400... |
227 228 229 |
.owner = THIS_MODULE, .llseek = no_llseek, .write = pnx4008_wdt_write, |
84ca995c2 [WATCHDOG 33/57] ... |
230 |
.unlocked_ioctl = pnx4008_wdt_ioctl, |
9325fa361 [WATCHDOG] pnx400... |
231 232 233 234 235 236 237 238 239 |
.open = pnx4008_wdt_open, .release = pnx4008_wdt_release, }; static struct miscdevice pnx4008_wdt_miscdev = { .minor = WATCHDOG_MINOR, .name = "watchdog", .fops = &pnx4008_wdt_fops, }; |
b6bf291f1 [WATCHDOG] move p... |
240 |
static int __devinit pnx4008_wdt_probe(struct platform_device *pdev) |
9325fa361 [WATCHDOG] pnx400... |
241 242 |
{ int ret = 0, size; |
9325fa361 [WATCHDOG] pnx400... |
243 244 245 246 247 248 249 |
if (heartbeat < 1 || heartbeat > MAX_HEARTBEAT) heartbeat = DEFAULT_HEARTBEAT; printk(KERN_INFO MODULE_NAME "PNX4008 Watchdog Timer: heartbeat %d sec ", heartbeat); |
f712eacf0 watchdog: Convert... |
250 251 |
wdt_mem = platform_get_resource(pdev, IORESOURCE_MEM, 0); if (wdt_mem == NULL) { |
9325fa361 [WATCHDOG] pnx400... |
252 253 254 255 256 |
printk(KERN_INFO MODULE_NAME "failed to get memory region resouce "); return -ENOENT; } |
f712eacf0 watchdog: Convert... |
257 |
size = resource_size(wdt_mem); |
9325fa361 [WATCHDOG] pnx400... |
258 |
|
f712eacf0 watchdog: Convert... |
259 |
if (!request_mem_region(wdt_mem->start, size, pdev->name)) { |
9325fa361 [WATCHDOG] pnx400... |
260 261 262 263 |
printk(KERN_INFO MODULE_NAME "failed to get memory region "); return -ENOENT; } |
f712eacf0 watchdog: Convert... |
264 |
wdt_base = (void __iomem *)IO_ADDRESS(wdt_mem->start); |
9325fa361 [WATCHDOG] pnx400... |
265 |
|
9bb787f43 ARM: PNX4008: con... |
266 |
wdt_clk = clk_get(&pdev->dev, NULL); |
9cd446198 [WATCHDOG] fix cl... |
267 268 |
if (IS_ERR(wdt_clk)) { ret = PTR_ERR(wdt_clk); |
f712eacf0 watchdog: Convert... |
269 270 |
release_mem_region(wdt_mem->start, size); wdt_mem = NULL; |
9325fa361 [WATCHDOG] pnx400... |
271 |
goto out; |
24fd1edaa ARM: PNX4008: con... |
272 273 274 275 |
} ret = clk_enable(wdt_clk); if (ret) { |
f712eacf0 watchdog: Convert... |
276 277 278 |
release_mem_region(wdt_mem->start, size); wdt_mem = NULL; clk_put(wdt_clk); |
24fd1edaa ARM: PNX4008: con... |
279 280 |
goto out; } |
9325fa361 [WATCHDOG] pnx400... |
281 282 283 284 285 |
ret = misc_register(&pnx4008_wdt_miscdev); if (ret < 0) { printk(KERN_ERR MODULE_NAME "cannot register misc device "); |
f712eacf0 watchdog: Convert... |
286 287 |
release_mem_region(wdt_mem->start, size); wdt_mem = NULL; |
24fd1edaa ARM: PNX4008: con... |
288 289 |
clk_disable(wdt_clk); clk_put(wdt_clk); |
9325fa361 [WATCHDOG] pnx400... |
290 291 292 293 |
} else { boot_status = (__raw_readl(WDTIM_RES(wdt_base)) & WDOG_RESET) ? WDIOF_CARDRESET : 0; wdt_disable(); /*disable for now */ |
24fd1edaa ARM: PNX4008: con... |
294 |
clk_disable(wdt_clk); |
9325fa361 [WATCHDOG] pnx400... |
295 296 297 298 299 300 |
set_bit(WDT_DEVICE_INITED, &wdt_status); } out: return ret; } |
b6bf291f1 [WATCHDOG] move p... |
301 |
static int __devexit pnx4008_wdt_remove(struct platform_device *pdev) |
9325fa361 [WATCHDOG] pnx400... |
302 |
{ |
f67644978 [WATCHDOG] pnx400... |
303 |
misc_deregister(&pnx4008_wdt_miscdev); |
24fd1edaa ARM: PNX4008: con... |
304 305 306 |
clk_disable(wdt_clk); clk_put(wdt_clk); |
f67644978 [WATCHDOG] pnx400... |
307 |
if (wdt_mem) { |
f712eacf0 watchdog: Convert... |
308 |
release_mem_region(wdt_mem->start, resource_size(wdt_mem)); |
f67644978 [WATCHDOG] pnx400... |
309 310 |
wdt_mem = NULL; } |
9325fa361 [WATCHDOG] pnx400... |
311 312 313 314 315 |
return 0; } static struct platform_driver platform_wdt_driver = { .driver = { |
1508c9950 ARM: PNX4008: fix... |
316 |
.name = "pnx4008-watchdog", |
f37d193c7 watchdog: fix pla... |
317 |
.owner = THIS_MODULE, |
9325fa361 [WATCHDOG] pnx400... |
318 319 |
}, .probe = pnx4008_wdt_probe, |
b6bf291f1 [WATCHDOG] move p... |
320 |
.remove = __devexit_p(pnx4008_wdt_remove), |
9325fa361 [WATCHDOG] pnx400... |
321 322 323 324 325 326 327 328 329 |
}; static int __init pnx4008_wdt_init(void) { return platform_driver_register(&platform_wdt_driver); } static void __exit pnx4008_wdt_exit(void) { |
bb0a38d89 [WATCHDOG] trivia... |
330 |
platform_driver_unregister(&platform_wdt_driver); |
9325fa361 [WATCHDOG] pnx400... |
331 332 333 334 335 336 337 338 339 340 341 342 343 344 345 346 347 348 349 350 |
} module_init(pnx4008_wdt_init); module_exit(pnx4008_wdt_exit); MODULE_AUTHOR("MontaVista Software, Inc. <source@mvista.com>"); MODULE_DESCRIPTION("PNX4008 Watchdog Driver"); module_param(heartbeat, int, 0); MODULE_PARM_DESC(heartbeat, "Watchdog heartbeat period in seconds from 1 to " __MODULE_STRING(MAX_HEARTBEAT) ", default " __MODULE_STRING(DEFAULT_HEARTBEAT)); module_param(nowayout, int, 0); MODULE_PARM_DESC(nowayout, "Set to 1 to keep watchdog running after device release"); MODULE_LICENSE("GPL"); MODULE_ALIAS_MISCDEV(WATCHDOG_MINOR); |
1508c9950 ARM: PNX4008: fix... |
351 |
MODULE_ALIAS("platform:pnx4008-watchdog"); |