Blame view
drivers/watchdog/ar7_wdt.c
7.69 KB
c283cf2c0 [WATCHDOG] AR7: w... |
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 |
/* * drivers/watchdog/ar7_wdt.c * * Copyright (C) 2007 Nicolas Thill <nico@openwrt.org> * Copyright (c) 2005 Enrik Berkhan <Enrik.Berkhan@akk.org> * * Some code taken from: * National Semiconductor SCx200 Watchdog support * Copyright (c) 2001,2002 Christer Weinigel <wingel@nano-system.com> * * This program is free software; you can redistribute it and/or modify * it under the terms of the GNU General Public License as published by * the Free Software Foundation; either version 2 of the License, or * (at your option) any later version. * * This program is distributed in the hope that it will be useful, * but WITHOUT ANY WARRANTY; without even the implied warranty of * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the * GNU General Public License for more details. * * You should have received a copy of the GNU General Public License * along with this program; if not, write to the Free Software * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA */ |
27c766aaa watchdog: Use pr_... |
25 |
#define pr_fmt(fmt) KBUILD_MODNAME ": " fmt |
c283cf2c0 [WATCHDOG] AR7: w... |
26 27 28 |
#include <linux/module.h> #include <linux/moduleparam.h> #include <linux/errno.h> |
c283cf2c0 [WATCHDOG] AR7: w... |
29 |
#include <linux/miscdevice.h> |
64d4062a3 [WATCHDOG] ar7_wd... |
30 |
#include <linux/platform_device.h> |
c283cf2c0 [WATCHDOG] AR7: w... |
31 |
#include <linux/watchdog.h> |
c283cf2c0 [WATCHDOG] AR7: w... |
32 33 34 35 |
#include <linux/fs.h> #include <linux/ioport.h> #include <linux/io.h> #include <linux/uaccess.h> |
780019ddf MIPS: AR7: Implem... |
36 |
#include <linux/clk.h> |
c283cf2c0 [WATCHDOG] AR7: w... |
37 38 |
#include <asm/addrspace.h> |
c5e7f5a38 [WATCHDOG] ar7_wd... |
39 |
#include <asm/mach-ar7/ar7.h> |
c283cf2c0 [WATCHDOG] AR7: w... |
40 |
|
c283cf2c0 [WATCHDOG] AR7: w... |
41 42 43 44 45 |
#define LONGNAME "TI AR7 Watchdog Timer" MODULE_AUTHOR("Nicolas Thill <nico@openwrt.org>"); MODULE_DESCRIPTION(LONGNAME); MODULE_LICENSE("GPL"); |
c283cf2c0 [WATCHDOG] AR7: w... |
46 47 48 49 |
static int margin = 60; module_param(margin, int, 0); MODULE_PARM_DESC(margin, "Watchdog margin in seconds"); |
86a1e1896 watchdog: nowayou... |
50 51 |
static bool nowayout = WATCHDOG_NOWAYOUT; module_param(nowayout, bool, 0); |
c283cf2c0 [WATCHDOG] AR7: w... |
52 53 54 55 56 57 58 59 60 61 62 63 64 65 66 |
MODULE_PARM_DESC(nowayout, "Disable watchdog shutdown on close"); #define READ_REG(x) readl((void __iomem *)&(x)) #define WRITE_REG(x, v) writel((v), (void __iomem *)&(x)) struct ar7_wdt { u32 kick_lock; u32 kick; u32 change_lock; u32 change; u32 disable_lock; u32 disable; u32 prescale_lock; u32 prescale; }; |
670d59c0a ar7_wdt watchdog ... |
67 |
static unsigned long wdt_is_open; |
c283cf2c0 [WATCHDOG] AR7: w... |
68 |
static unsigned expect_close; |
1334f3293 watchdog: Use DEF... |
69 |
static DEFINE_SPINLOCK(wdt_lock); |
c283cf2c0 [WATCHDOG] AR7: w... |
70 71 72 |
/* XXX currently fixed, allows max margin ~68.72 secs */ #define prescale_value 0xffff |
64d4062a3 [WATCHDOG] ar7_wd... |
73 74 |
/* Resource of the WDT registers */ static struct resource *ar7_regs_wdt; |
c283cf2c0 [WATCHDOG] AR7: w... |
75 76 |
/* Pointer to the remapped WDT IO space */ static struct ar7_wdt *ar7_wdt; |
c283cf2c0 [WATCHDOG] AR7: w... |
77 |
|
780019ddf MIPS: AR7: Implem... |
78 |
static struct clk *vbus_clk; |
c283cf2c0 [WATCHDOG] AR7: w... |
79 80 81 82 83 84 85 86 87 88 |
static void ar7_wdt_kick(u32 value) { WRITE_REG(ar7_wdt->kick_lock, 0x5555); if ((READ_REG(ar7_wdt->kick_lock) & 3) == 1) { WRITE_REG(ar7_wdt->kick_lock, 0xaaaa); if ((READ_REG(ar7_wdt->kick_lock) & 3) == 3) { WRITE_REG(ar7_wdt->kick, value); return; } } |
27c766aaa watchdog: Use pr_... |
89 90 |
pr_err("failed to unlock WDT kick reg "); |
c283cf2c0 [WATCHDOG] AR7: w... |
91 92 93 94 95 96 97 98 99 100 101 102 |
} static void ar7_wdt_prescale(u32 value) { WRITE_REG(ar7_wdt->prescale_lock, 0x5a5a); if ((READ_REG(ar7_wdt->prescale_lock) & 3) == 1) { WRITE_REG(ar7_wdt->prescale_lock, 0xa5a5); if ((READ_REG(ar7_wdt->prescale_lock) & 3) == 3) { WRITE_REG(ar7_wdt->prescale, value); return; } } |
27c766aaa watchdog: Use pr_... |
103 104 |
pr_err("failed to unlock WDT prescale reg "); |
c283cf2c0 [WATCHDOG] AR7: w... |
105 106 107 108 109 110 111 112 113 114 115 116 |
} static void ar7_wdt_change(u32 value) { WRITE_REG(ar7_wdt->change_lock, 0x6666); if ((READ_REG(ar7_wdt->change_lock) & 3) == 1) { WRITE_REG(ar7_wdt->change_lock, 0xbbbb); if ((READ_REG(ar7_wdt->change_lock) & 3) == 3) { WRITE_REG(ar7_wdt->change, value); return; } } |
27c766aaa watchdog: Use pr_... |
117 118 |
pr_err("failed to unlock WDT change reg "); |
c283cf2c0 [WATCHDOG] AR7: w... |
119 120 121 122 123 124 125 126 127 128 129 130 131 132 133 |
} static void ar7_wdt_disable(u32 value) { WRITE_REG(ar7_wdt->disable_lock, 0x7777); if ((READ_REG(ar7_wdt->disable_lock) & 3) == 1) { WRITE_REG(ar7_wdt->disable_lock, 0xcccc); if ((READ_REG(ar7_wdt->disable_lock) & 3) == 2) { WRITE_REG(ar7_wdt->disable_lock, 0xdddd); if ((READ_REG(ar7_wdt->disable_lock) & 3) == 3) { WRITE_REG(ar7_wdt->disable, value); return; } } } |
27c766aaa watchdog: Use pr_... |
134 135 |
pr_err("failed to unlock WDT disable reg "); |
c283cf2c0 [WATCHDOG] AR7: w... |
136 137 138 139 140 |
} static void ar7_wdt_update_margin(int new_margin) { u32 change; |
780019ddf MIPS: AR7: Implem... |
141 |
u32 vbus_rate; |
c283cf2c0 [WATCHDOG] AR7: w... |
142 |
|
780019ddf MIPS: AR7: Implem... |
143 144 |
vbus_rate = clk_get_rate(vbus_clk); change = new_margin * (vbus_rate / prescale_value); |
670d59c0a ar7_wdt watchdog ... |
145 146 147 148 |
if (change < 1) change = 1; if (change > 0xffff) change = 0xffff; |
c283cf2c0 [WATCHDOG] AR7: w... |
149 |
ar7_wdt_change(change); |
780019ddf MIPS: AR7: Implem... |
150 |
margin = change * prescale_value / vbus_rate; |
27c766aaa watchdog: Use pr_... |
151 152 153 |
pr_info("timer margin %d seconds (prescale %d, change %d, freq %d) ", margin, prescale_value, change, vbus_rate); |
c283cf2c0 [WATCHDOG] AR7: w... |
154 155 156 157 |
} static void ar7_wdt_enable_wdt(void) { |
27c766aaa watchdog: Use pr_... |
158 159 |
pr_debug("enabling watchdog timer "); |
c283cf2c0 [WATCHDOG] AR7: w... |
160 161 162 163 164 165 |
ar7_wdt_disable(1); ar7_wdt_kick(1); } static void ar7_wdt_disable_wdt(void) { |
27c766aaa watchdog: Use pr_... |
166 167 |
pr_debug("disabling watchdog timer "); |
c283cf2c0 [WATCHDOG] AR7: w... |
168 169 170 171 172 173 |
ar7_wdt_disable(0); } static int ar7_wdt_open(struct inode *inode, struct file *file) { /* only allow one at a time */ |
670d59c0a ar7_wdt watchdog ... |
174 |
if (test_and_set_bit(0, &wdt_is_open)) |
c283cf2c0 [WATCHDOG] AR7: w... |
175 176 177 178 179 180 181 182 183 184 |
return -EBUSY; ar7_wdt_enable_wdt(); expect_close = 0; return nonseekable_open(inode, file); } static int ar7_wdt_release(struct inode *inode, struct file *file) { if (!expect_close) |
27c766aaa watchdog: Use pr_... |
185 186 |
pr_warn("watchdog device closed unexpectedly, will not disable the watchdog timer "); |
c283cf2c0 [WATCHDOG] AR7: w... |
187 188 |
else if (!nowayout) ar7_wdt_disable_wdt(); |
670d59c0a ar7_wdt watchdog ... |
189 |
clear_bit(0, &wdt_is_open); |
c283cf2c0 [WATCHDOG] AR7: w... |
190 191 |
return 0; } |
c283cf2c0 [WATCHDOG] AR7: w... |
192 193 194 195 196 197 |
static ssize_t ar7_wdt_write(struct file *file, const char *data, size_t len, loff_t *ppos) { /* check for a magic close character */ if (len) { size_t i; |
670d59c0a ar7_wdt watchdog ... |
198 |
spin_lock(&wdt_lock); |
c283cf2c0 [WATCHDOG] AR7: w... |
199 |
ar7_wdt_kick(1); |
670d59c0a ar7_wdt watchdog ... |
200 |
spin_unlock(&wdt_lock); |
c283cf2c0 [WATCHDOG] AR7: w... |
201 202 203 204 |
expect_close = 0; for (i = 0; i < len; ++i) { char c; |
7944d3a5a [WATCHDOG] more c... |
205 |
if (get_user(c, data + i)) |
c283cf2c0 [WATCHDOG] AR7: w... |
206 207 208 209 210 211 212 213 |
return -EFAULT; if (c == 'V') expect_close = 1; } } return len; } |
670d59c0a ar7_wdt watchdog ... |
214 215 |
static long ar7_wdt_ioctl(struct file *file, unsigned int cmd, unsigned long arg) |
c283cf2c0 [WATCHDOG] AR7: w... |
216 |
{ |
42747d712 [WATCHDOG] watchd... |
217 |
static const struct watchdog_info ident = { |
c283cf2c0 [WATCHDOG] AR7: w... |
218 219 |
.identity = LONGNAME, .firmware_version = 1, |
e73a78027 [WATCHDOG] Correc... |
220 221 |
.options = (WDIOF_SETTIMEOUT | WDIOF_KEEPALIVEPING | WDIOF_MAGICCLOSE), |
c283cf2c0 [WATCHDOG] AR7: w... |
222 223 224 225 |
}; int new_margin; switch (cmd) { |
c283cf2c0 [WATCHDOG] AR7: w... |
226 227 228 229 230 231 232 233 234 235 236 237 238 239 240 241 242 243 |
case WDIOC_GETSUPPORT: if (copy_to_user((struct watchdog_info *)arg, &ident, sizeof(ident))) return -EFAULT; return 0; case WDIOC_GETSTATUS: case WDIOC_GETBOOTSTATUS: if (put_user(0, (int *)arg)) return -EFAULT; return 0; case WDIOC_KEEPALIVE: ar7_wdt_kick(1); return 0; case WDIOC_SETTIMEOUT: if (get_user(new_margin, (int *)arg)) return -EFAULT; if (new_margin < 1) return -EINVAL; |
670d59c0a ar7_wdt watchdog ... |
244 |
spin_lock(&wdt_lock); |
c283cf2c0 [WATCHDOG] AR7: w... |
245 246 |
ar7_wdt_update_margin(new_margin); ar7_wdt_kick(1); |
670d59c0a ar7_wdt watchdog ... |
247 |
spin_unlock(&wdt_lock); |
c283cf2c0 [WATCHDOG] AR7: w... |
248 249 250 251 252 |
case WDIOC_GETTIMEOUT: if (put_user(margin, (int *)arg)) return -EFAULT; return 0; |
0c06090c9 [WATCHDOG] Coding... |
253 254 |
default: return -ENOTTY; |
c283cf2c0 [WATCHDOG] AR7: w... |
255 256 |
} } |
b47a166ed [WATCHDOG] consti... |
257 |
static const struct file_operations ar7_wdt_fops = { |
c283cf2c0 [WATCHDOG] AR7: w... |
258 259 |
.owner = THIS_MODULE, .write = ar7_wdt_write, |
670d59c0a ar7_wdt watchdog ... |
260 |
.unlocked_ioctl = ar7_wdt_ioctl, |
c283cf2c0 [WATCHDOG] AR7: w... |
261 262 |
.open = ar7_wdt_open, .release = ar7_wdt_release, |
6038f373a llseek: automatic... |
263 |
.llseek = no_llseek, |
c283cf2c0 [WATCHDOG] AR7: w... |
264 265 266 267 268 269 270 |
}; static struct miscdevice ar7_wdt_miscdev = { .minor = WATCHDOG_MINOR, .name = "watchdog", .fops = &ar7_wdt_fops, }; |
2d991a164 watchdog: remove ... |
271 |
static int ar7_wdt_probe(struct platform_device *pdev) |
c283cf2c0 [WATCHDOG] AR7: w... |
272 273 |
{ int rc; |
64d4062a3 [WATCHDOG] ar7_wd... |
274 275 |
ar7_regs_wdt = platform_get_resource_byname(pdev, IORESOURCE_MEM, "regs"); |
4c271bb67 watchdog: Convert... |
276 277 278 |
ar7_wdt = devm_ioremap_resource(&pdev->dev, ar7_regs_wdt); if (IS_ERR(ar7_wdt)) return PTR_ERR(ar7_wdt); |
c283cf2c0 [WATCHDOG] AR7: w... |
279 |
|
780019ddf MIPS: AR7: Implem... |
280 281 |
vbus_clk = clk_get(NULL, "vbus"); if (IS_ERR(vbus_clk)) { |
27c766aaa watchdog: Use pr_... |
282 283 |
pr_err("could not get vbus clock "); |
ae21cc20a watchdog: ar7_wdt... |
284 |
return PTR_ERR(vbus_clk); |
780019ddf MIPS: AR7: Implem... |
285 |
} |
c283cf2c0 [WATCHDOG] AR7: w... |
286 287 288 |
ar7_wdt_disable_wdt(); ar7_wdt_prescale(prescale_value); ar7_wdt_update_margin(margin); |
c283cf2c0 [WATCHDOG] AR7: w... |
289 290 |
rc = misc_register(&ar7_wdt_miscdev); if (rc) { |
27c766aaa watchdog: Use pr_... |
291 292 |
pr_err("unable to register misc device "); |
ae21cc20a watchdog: ar7_wdt... |
293 |
goto out; |
c283cf2c0 [WATCHDOG] AR7: w... |
294 |
} |
ae21cc20a watchdog: ar7_wdt... |
295 |
return 0; |
c283cf2c0 [WATCHDOG] AR7: w... |
296 |
|
c283cf2c0 [WATCHDOG] AR7: w... |
297 |
out: |
ae21cc20a watchdog: ar7_wdt... |
298 299 |
clk_put(vbus_clk); vbus_clk = NULL; |
c283cf2c0 [WATCHDOG] AR7: w... |
300 301 |
return rc; } |
4b12b896c watchdog: remove ... |
302 |
static int ar7_wdt_remove(struct platform_device *pdev) |
c283cf2c0 [WATCHDOG] AR7: w... |
303 304 |
{ misc_deregister(&ar7_wdt_miscdev); |
ae21cc20a watchdog: ar7_wdt... |
305 306 |
clk_put(vbus_clk); vbus_clk = NULL; |
64d4062a3 [WATCHDOG] ar7_wd... |
307 308 309 310 311 312 313 314 315 316 317 |
return 0; } static void ar7_wdt_shutdown(struct platform_device *pdev) { if (!nowayout) ar7_wdt_disable_wdt(); } static struct platform_driver ar7_wdt_driver = { .probe = ar7_wdt_probe, |
82268714b watchdog: remove ... |
318 |
.remove = ar7_wdt_remove, |
64d4062a3 [WATCHDOG] ar7_wd... |
319 320 |
.shutdown = ar7_wdt_shutdown, .driver = { |
64d4062a3 [WATCHDOG] ar7_wd... |
321 322 323 |
.name = "ar7_wdt", }, }; |
b8ec61189 watchdog: convert... |
324 |
module_platform_driver(ar7_wdt_driver); |