103ec5856SFlorian Fainelli /* 203ec5856SFlorian Fainelli * IDT Interprise 79RC32434 watchdog driver 303ec5856SFlorian Fainelli * 403ec5856SFlorian Fainelli * Copyright (C) 2006, Ondrej Zajicek <santiago@crfreenet.org> 503ec5856SFlorian Fainelli * Copyright (C) 2008, Florian Fainelli <florian@openwrt.org> 603ec5856SFlorian Fainelli * 703ec5856SFlorian Fainelli * based on 803ec5856SFlorian Fainelli * SoftDog 0.05: A Software Watchdog Device 903ec5856SFlorian Fainelli * 1029fa0586SAlan Cox * (c) Copyright 1996 Alan Cox <alan@lxorguk.ukuu.org.uk>, 1129fa0586SAlan Cox * All Rights Reserved. 1203ec5856SFlorian Fainelli * 1303ec5856SFlorian Fainelli * This program is free software; you can redistribute it and/or 1403ec5856SFlorian Fainelli * modify it under the terms of the GNU General Public License 1503ec5856SFlorian Fainelli * as published by the Free Software Foundation; either version 1603ec5856SFlorian Fainelli * 2 of the License, or (at your option) any later version. 1703ec5856SFlorian Fainelli * 1803ec5856SFlorian Fainelli */ 1903ec5856SFlorian Fainelli 2003ec5856SFlorian Fainelli #include <linux/module.h> 2103ec5856SFlorian Fainelli #include <linux/types.h> 2203ec5856SFlorian Fainelli #include <linux/kernel.h> 2303ec5856SFlorian Fainelli #include <linux/fs.h> 2403ec5856SFlorian Fainelli #include <linux/mm.h> 2503ec5856SFlorian Fainelli #include <linux/miscdevice.h> 2603ec5856SFlorian Fainelli #include <linux/watchdog.h> 2703ec5856SFlorian Fainelli #include <linux/reboot.h> 2803ec5856SFlorian Fainelli #include <linux/smp_lock.h> 2903ec5856SFlorian Fainelli #include <linux/init.h> 3003ec5856SFlorian Fainelli #include <linux/platform_device.h> 3103ec5856SFlorian Fainelli #include <linux/uaccess.h> 3203ec5856SFlorian Fainelli 3303ec5856SFlorian Fainelli #include <asm/bootinfo.h> 3403ec5856SFlorian Fainelli #include <asm/time.h> 3503ec5856SFlorian Fainelli #include <asm/mach-rc32434/integ.h> 3603ec5856SFlorian Fainelli 37*0af98d37SPhil Sutter #define VERSION "0.3" 3803ec5856SFlorian Fainelli 3903ec5856SFlorian Fainelli static struct { 4003ec5856SFlorian Fainelli unsigned long inuse; 4103ec5856SFlorian Fainelli } rc32434_wdt_device; 4203ec5856SFlorian Fainelli 4303ec5856SFlorian Fainelli static struct integ __iomem *wdt_reg; 4403ec5856SFlorian Fainelli 4503ec5856SFlorian Fainelli static int expect_close; 46*0af98d37SPhil Sutter 47*0af98d37SPhil Sutter /* Board internal clock speed in Hz, 48*0af98d37SPhil Sutter * the watchdog timer ticks at. */ 49*0af98d37SPhil Sutter extern unsigned int idt_cpu_freq; 50*0af98d37SPhil Sutter 51*0af98d37SPhil Sutter /* translate wtcompare value to seconds and vice versa */ 52*0af98d37SPhil Sutter #define WTCOMP2SEC(x) (x / idt_cpu_freq) 53*0af98d37SPhil Sutter #define SEC2WTCOMP(x) (x * idt_cpu_freq) 54*0af98d37SPhil Sutter 55*0af98d37SPhil Sutter /* Use a default timeout of 20s. This should be 56*0af98d37SPhil Sutter * safe for CPU clock speeds up to 400MHz, as 57*0af98d37SPhil Sutter * ((2 ^ 32) - 1) / (400MHz / 2) = 21s. */ 58*0af98d37SPhil Sutter #define WATCHDOG_TIMEOUT 20 59*0af98d37SPhil Sutter 60*0af98d37SPhil Sutter static int timeout = WATCHDOG_TIMEOUT; 6103ec5856SFlorian Fainelli 6203ec5856SFlorian Fainelli static int nowayout = WATCHDOG_NOWAYOUT; 6303ec5856SFlorian Fainelli module_param(nowayout, int, 0); 6403ec5856SFlorian Fainelli MODULE_PARM_DESC(nowayout, "Watchdog cannot be stopped once started (default=" 6503ec5856SFlorian Fainelli __MODULE_STRING(WATCHDOG_NOWAYOUT) ")"); 6603ec5856SFlorian Fainelli 67*0af98d37SPhil Sutter /* apply or and nand masks to data read from addr and write back */ 68*0af98d37SPhil Sutter #define SET_BITS(addr, or, nand) \ 69*0af98d37SPhil Sutter writel((readl(&addr) | or) & ~nand, &addr) 7003ec5856SFlorian Fainelli 7103ec5856SFlorian Fainelli static void rc32434_wdt_start(void) 7203ec5856SFlorian Fainelli { 73*0af98d37SPhil Sutter u32 or, nand; 7403ec5856SFlorian Fainelli 75*0af98d37SPhil Sutter /* zero the counter before enabling */ 7603ec5856SFlorian Fainelli writel(0, &wdt_reg->wtcount); 7703ec5856SFlorian Fainelli 78*0af98d37SPhil Sutter /* don't generate a non-maskable interrupt, 79*0af98d37SPhil Sutter * do a warm reset instead */ 80*0af98d37SPhil Sutter nand = 1 << RC32434_ERR_WNE; 81*0af98d37SPhil Sutter or = 1 << RC32434_ERR_WRE; 8203ec5856SFlorian Fainelli 83*0af98d37SPhil Sutter /* reset the ERRCS timeout bit in case it's set */ 84*0af98d37SPhil Sutter nand |= 1 << RC32434_ERR_WTO; 85*0af98d37SPhil Sutter 86*0af98d37SPhil Sutter SET_BITS(wdt_reg->errcs, or, nand); 87*0af98d37SPhil Sutter 88*0af98d37SPhil Sutter /* reset WTC timeout bit and enable WDT */ 89*0af98d37SPhil Sutter nand = 1 << RC32434_WTC_TO; 90*0af98d37SPhil Sutter or = 1 << RC32434_WTC_EN; 91*0af98d37SPhil Sutter 92*0af98d37SPhil Sutter SET_BITS(wdt_reg->wtc, or, nand); 9303ec5856SFlorian Fainelli } 9403ec5856SFlorian Fainelli 9503ec5856SFlorian Fainelli static void rc32434_wdt_stop(void) 9603ec5856SFlorian Fainelli { 97*0af98d37SPhil Sutter /* Disable WDT */ 98*0af98d37SPhil Sutter SET_BITS(wdt_reg->wtc, 0, 1 << RC32434_WTC_EN); 9903ec5856SFlorian Fainelli } 10003ec5856SFlorian Fainelli 101*0af98d37SPhil Sutter static int rc32434_wdt_set(int new_timeout) 10203ec5856SFlorian Fainelli { 103*0af98d37SPhil Sutter int max_to = WTCOMP2SEC((u32)-1); 10403ec5856SFlorian Fainelli 105*0af98d37SPhil Sutter if (new_timeout < 0 || new_timeout > max_to) { 106*0af98d37SPhil Sutter printk(KERN_ERR KBUILD_MODNAME 107*0af98d37SPhil Sutter ": timeout value must be between 0 and %d", 108*0af98d37SPhil Sutter max_to); 109*0af98d37SPhil Sutter return -EINVAL; 110*0af98d37SPhil Sutter } 11103ec5856SFlorian Fainelli timeout = new_timeout; 112*0af98d37SPhil Sutter writel(SEC2WTCOMP(timeout), &wdt_reg->wtcompare); 11303ec5856SFlorian Fainelli 114*0af98d37SPhil Sutter return 0; 11503ec5856SFlorian Fainelli } 11603ec5856SFlorian Fainelli 117*0af98d37SPhil Sutter static void rc32434_wdt_ping(void) 11803ec5856SFlorian Fainelli { 11903ec5856SFlorian Fainelli writel(0, &wdt_reg->wtcount); 12003ec5856SFlorian Fainelli } 12103ec5856SFlorian Fainelli 12203ec5856SFlorian Fainelli static int rc32434_wdt_open(struct inode *inode, struct file *file) 12303ec5856SFlorian Fainelli { 12403ec5856SFlorian Fainelli if (test_and_set_bit(0, &rc32434_wdt_device.inuse)) 12503ec5856SFlorian Fainelli return -EBUSY; 12603ec5856SFlorian Fainelli 12703ec5856SFlorian Fainelli if (nowayout) 12803ec5856SFlorian Fainelli __module_get(THIS_MODULE); 12903ec5856SFlorian Fainelli 130*0af98d37SPhil Sutter rc32434_wdt_start(); 131*0af98d37SPhil Sutter rc32434_wdt_ping(); 132*0af98d37SPhil Sutter 13303ec5856SFlorian Fainelli return nonseekable_open(inode, file); 13403ec5856SFlorian Fainelli } 13503ec5856SFlorian Fainelli 13603ec5856SFlorian Fainelli static int rc32434_wdt_release(struct inode *inode, struct file *file) 13703ec5856SFlorian Fainelli { 138*0af98d37SPhil Sutter if (expect_close == 42) { 13903ec5856SFlorian Fainelli rc32434_wdt_stop(); 14003ec5856SFlorian Fainelli printk(KERN_INFO KBUILD_MODNAME ": disabling watchdog timer\n"); 14103ec5856SFlorian Fainelli module_put(THIS_MODULE); 142*0af98d37SPhil Sutter } else { 14303ec5856SFlorian Fainelli printk(KERN_CRIT KBUILD_MODNAME 14403ec5856SFlorian Fainelli ": device closed unexpectedly. WDT will not stop !\n"); 145*0af98d37SPhil Sutter rc32434_wdt_ping(); 146*0af98d37SPhil Sutter } 14703ec5856SFlorian Fainelli clear_bit(0, &rc32434_wdt_device.inuse); 14803ec5856SFlorian Fainelli return 0; 14903ec5856SFlorian Fainelli } 15003ec5856SFlorian Fainelli 15103ec5856SFlorian Fainelli static ssize_t rc32434_wdt_write(struct file *file, const char *data, 15203ec5856SFlorian Fainelli size_t len, loff_t *ppos) 15303ec5856SFlorian Fainelli { 15403ec5856SFlorian Fainelli if (len) { 15503ec5856SFlorian Fainelli if (!nowayout) { 15603ec5856SFlorian Fainelli size_t i; 15703ec5856SFlorian Fainelli 15803ec5856SFlorian Fainelli /* In case it was set long ago */ 15903ec5856SFlorian Fainelli expect_close = 0; 16003ec5856SFlorian Fainelli 16103ec5856SFlorian Fainelli for (i = 0; i != len; i++) { 16203ec5856SFlorian Fainelli char c; 16303ec5856SFlorian Fainelli if (get_user(c, data + i)) 16403ec5856SFlorian Fainelli return -EFAULT; 16503ec5856SFlorian Fainelli if (c == 'V') 166*0af98d37SPhil Sutter expect_close = 42; 16703ec5856SFlorian Fainelli } 16803ec5856SFlorian Fainelli } 169*0af98d37SPhil Sutter rc32434_wdt_ping(); 17003ec5856SFlorian Fainelli return len; 17103ec5856SFlorian Fainelli } 17203ec5856SFlorian Fainelli return 0; 17303ec5856SFlorian Fainelli } 17403ec5856SFlorian Fainelli 1757275fc8cSWim Van Sebroeck static long rc32434_wdt_ioctl(struct file *file, unsigned int cmd, 1767275fc8cSWim Van Sebroeck unsigned long arg) 17703ec5856SFlorian Fainelli { 17803ec5856SFlorian Fainelli void __user *argp = (void __user *)arg; 17903ec5856SFlorian Fainelli int new_timeout; 18003ec5856SFlorian Fainelli unsigned int value; 18103ec5856SFlorian Fainelli static struct watchdog_info ident = { 18203ec5856SFlorian Fainelli .options = WDIOF_SETTIMEOUT | 18303ec5856SFlorian Fainelli WDIOF_KEEPALIVEPING | 18403ec5856SFlorian Fainelli WDIOF_MAGICCLOSE, 18503ec5856SFlorian Fainelli .identity = "RC32434_WDT Watchdog", 18603ec5856SFlorian Fainelli }; 18703ec5856SFlorian Fainelli switch (cmd) { 18803ec5856SFlorian Fainelli case WDIOC_KEEPALIVE: 189*0af98d37SPhil Sutter rc32434_wdt_ping(); 19003ec5856SFlorian Fainelli break; 19103ec5856SFlorian Fainelli case WDIOC_GETSTATUS: 19203ec5856SFlorian Fainelli case WDIOC_GETBOOTSTATUS: 193*0af98d37SPhil Sutter value = 0; 19403ec5856SFlorian Fainelli if (copy_to_user(argp, &value, sizeof(int))) 19503ec5856SFlorian Fainelli return -EFAULT; 19603ec5856SFlorian Fainelli break; 19703ec5856SFlorian Fainelli case WDIOC_GETSUPPORT: 19803ec5856SFlorian Fainelli if (copy_to_user(argp, &ident, sizeof(ident))) 19903ec5856SFlorian Fainelli return -EFAULT; 20003ec5856SFlorian Fainelli break; 20103ec5856SFlorian Fainelli case WDIOC_SETOPTIONS: 20203ec5856SFlorian Fainelli if (copy_from_user(&value, argp, sizeof(int))) 20303ec5856SFlorian Fainelli return -EFAULT; 20403ec5856SFlorian Fainelli switch (value) { 20503ec5856SFlorian Fainelli case WDIOS_ENABLECARD: 20603ec5856SFlorian Fainelli rc32434_wdt_start(); 20703ec5856SFlorian Fainelli break; 20803ec5856SFlorian Fainelli case WDIOS_DISABLECARD: 20903ec5856SFlorian Fainelli rc32434_wdt_stop(); 210*0af98d37SPhil Sutter break; 21103ec5856SFlorian Fainelli default: 21203ec5856SFlorian Fainelli return -EINVAL; 21303ec5856SFlorian Fainelli } 21403ec5856SFlorian Fainelli break; 21503ec5856SFlorian Fainelli case WDIOC_SETTIMEOUT: 21603ec5856SFlorian Fainelli if (copy_from_user(&new_timeout, argp, sizeof(int))) 21703ec5856SFlorian Fainelli return -EFAULT; 218*0af98d37SPhil Sutter if (rc32434_wdt_set(new_timeout)) 21903ec5856SFlorian Fainelli return -EINVAL; 220*0af98d37SPhil Sutter /* Fall through */ 22103ec5856SFlorian Fainelli case WDIOC_GETTIMEOUT: 22203ec5856SFlorian Fainelli return copy_to_user(argp, &timeout, sizeof(int)); 22303ec5856SFlorian Fainelli default: 22403ec5856SFlorian Fainelli return -ENOTTY; 22503ec5856SFlorian Fainelli } 22603ec5856SFlorian Fainelli 22703ec5856SFlorian Fainelli return 0; 22803ec5856SFlorian Fainelli } 22903ec5856SFlorian Fainelli 23003ec5856SFlorian Fainelli static struct file_operations rc32434_wdt_fops = { 23103ec5856SFlorian Fainelli .owner = THIS_MODULE, 23203ec5856SFlorian Fainelli .llseek = no_llseek, 23303ec5856SFlorian Fainelli .write = rc32434_wdt_write, 2347275fc8cSWim Van Sebroeck .unlocked_ioctl = rc32434_wdt_ioctl, 23503ec5856SFlorian Fainelli .open = rc32434_wdt_open, 23603ec5856SFlorian Fainelli .release = rc32434_wdt_release, 23703ec5856SFlorian Fainelli }; 23803ec5856SFlorian Fainelli 23903ec5856SFlorian Fainelli static struct miscdevice rc32434_wdt_miscdev = { 24003ec5856SFlorian Fainelli .minor = WATCHDOG_MINOR, 24103ec5856SFlorian Fainelli .name = "watchdog", 24203ec5856SFlorian Fainelli .fops = &rc32434_wdt_fops, 24303ec5856SFlorian Fainelli }; 24403ec5856SFlorian Fainelli 24503ec5856SFlorian Fainelli static char banner[] = KERN_INFO KBUILD_MODNAME 24603ec5856SFlorian Fainelli ": Watchdog Timer version " VERSION ", timer margin: %d sec\n"; 24703ec5856SFlorian Fainelli 24803ec5856SFlorian Fainelli static int rc32434_wdt_probe(struct platform_device *pdev) 24903ec5856SFlorian Fainelli { 25003ec5856SFlorian Fainelli int ret; 25103ec5856SFlorian Fainelli struct resource *r; 25203ec5856SFlorian Fainelli 253*0af98d37SPhil Sutter r = platform_get_resource_byname(pdev, IORESOURCE_MEM, "rb532_wdt_res"); 25403ec5856SFlorian Fainelli if (!r) { 25503ec5856SFlorian Fainelli printk(KERN_ERR KBUILD_MODNAME 25603ec5856SFlorian Fainelli "failed to retrieve resources\n"); 25703ec5856SFlorian Fainelli return -ENODEV; 25803ec5856SFlorian Fainelli } 25903ec5856SFlorian Fainelli 26003ec5856SFlorian Fainelli wdt_reg = ioremap_nocache(r->start, r->end - r->start); 26103ec5856SFlorian Fainelli if (!wdt_reg) { 26203ec5856SFlorian Fainelli printk(KERN_ERR KBUILD_MODNAME 26303ec5856SFlorian Fainelli "failed to remap I/O resources\n"); 26403ec5856SFlorian Fainelli return -ENXIO; 26503ec5856SFlorian Fainelli } 26603ec5856SFlorian Fainelli 26703ec5856SFlorian Fainelli ret = misc_register(&rc32434_wdt_miscdev); 26803ec5856SFlorian Fainelli if (ret < 0) { 26903ec5856SFlorian Fainelli printk(KERN_ERR KBUILD_MODNAME 27003ec5856SFlorian Fainelli "failed to register watchdog device\n"); 27103ec5856SFlorian Fainelli goto unmap; 27203ec5856SFlorian Fainelli } 27303ec5856SFlorian Fainelli 27403ec5856SFlorian Fainelli printk(banner, timeout); 27503ec5856SFlorian Fainelli 27603ec5856SFlorian Fainelli return 0; 27703ec5856SFlorian Fainelli 27803ec5856SFlorian Fainelli unmap: 27903ec5856SFlorian Fainelli iounmap(wdt_reg); 28003ec5856SFlorian Fainelli return ret; 28103ec5856SFlorian Fainelli } 28203ec5856SFlorian Fainelli 28303ec5856SFlorian Fainelli static int rc32434_wdt_remove(struct platform_device *pdev) 28403ec5856SFlorian Fainelli { 28503ec5856SFlorian Fainelli misc_deregister(&rc32434_wdt_miscdev); 28603ec5856SFlorian Fainelli iounmap(wdt_reg); 28703ec5856SFlorian Fainelli return 0; 28803ec5856SFlorian Fainelli } 28903ec5856SFlorian Fainelli 29003ec5856SFlorian Fainelli static struct platform_driver rc32434_wdt = { 29103ec5856SFlorian Fainelli .probe = rc32434_wdt_probe, 29203ec5856SFlorian Fainelli .remove = rc32434_wdt_remove, 29303ec5856SFlorian Fainelli .driver = { 29403ec5856SFlorian Fainelli .name = "rc32434_wdt", 29503ec5856SFlorian Fainelli } 29603ec5856SFlorian Fainelli }; 29703ec5856SFlorian Fainelli 29803ec5856SFlorian Fainelli static int __init rc32434_wdt_init(void) 29903ec5856SFlorian Fainelli { 30003ec5856SFlorian Fainelli return platform_driver_register(&rc32434_wdt); 30103ec5856SFlorian Fainelli } 30203ec5856SFlorian Fainelli 30303ec5856SFlorian Fainelli static void __exit rc32434_wdt_exit(void) 30403ec5856SFlorian Fainelli { 30503ec5856SFlorian Fainelli platform_driver_unregister(&rc32434_wdt); 30603ec5856SFlorian Fainelli } 30703ec5856SFlorian Fainelli 30803ec5856SFlorian Fainelli module_init(rc32434_wdt_init); 30903ec5856SFlorian Fainelli module_exit(rc32434_wdt_exit); 31003ec5856SFlorian Fainelli 31103ec5856SFlorian Fainelli MODULE_AUTHOR("Ondrej Zajicek <santiago@crfreenet.org>," 31203ec5856SFlorian Fainelli "Florian Fainelli <florian@openwrt.org>"); 31303ec5856SFlorian Fainelli MODULE_DESCRIPTION("Driver for the IDT RC32434 SoC watchdog"); 31403ec5856SFlorian Fainelli MODULE_LICENSE("GPL"); 31503ec5856SFlorian Fainelli MODULE_ALIAS_MISCDEV(WATCHDOG_MINOR); 316