diff options
Diffstat (limited to 'target/linux/cns3xxx/patches/053-cns3xxx_wdt.patch')
| -rw-r--r-- | target/linux/cns3xxx/patches/053-cns3xxx_wdt.patch | 77 |
1 files changed, 77 insertions, 0 deletions
diff --git a/target/linux/cns3xxx/patches/053-cns3xxx_wdt.patch b/target/linux/cns3xxx/patches/053-cns3xxx_wdt.patch new file mode 100644 index 0000000000..85a73ab1dd --- /dev/null +++ b/target/linux/cns3xxx/patches/053-cns3xxx_wdt.patch @@ -0,0 +1,77 @@ +--- a/drivers/watchdog/Kconfig ++++ b/drivers/watchdog/Kconfig +@@ -188,7 +188,7 @@ config SA1100_WATCHDOG + + config MPCORE_WATCHDOG + tristate "MPcore watchdog" +- depends on HAVE_ARM_TWD ++ depends on ARCH_CNS3XXX + help + Watchdog timer embedded into the MPcore system. + +--- a/drivers/watchdog/mpcore_wdt.c ++++ b/drivers/watchdog/mpcore_wdt.c +@@ -32,11 +32,14 @@ + #include <linux/uaccess.h> + #include <linux/slab.h> + #include <linux/io.h> ++#include <linux/jiffies.h> ++#include <linux/delay.h> + + #include <asm/smp_twd.h> + + struct mpcore_wdt { + unsigned long timer_alive; ++ unsigned long timer_rate; + struct device *dev; + void __iomem *base; + int irq; +@@ -98,14 +101,12 @@ static void mpcore_wdt_keepalive(struct + unsigned long count; + + spin_lock(&wdt_lock); +- /* Assume prescale is set to 256 */ +- count = __raw_readl(wdt->base + TWD_WDOG_COUNTER); +- count = (0xFFFFFFFFU - count) * (HZ / 5); +- count = (count / 256) * mpcore_margin; ++ count = (wdt->timer_rate / 256) * mpcore_margin; + + /* Reload the counter */ + writel(count + wdt->perturb, wdt->base + TWD_WDOG_LOAD); + wdt->perturb = wdt->perturb ? 0 : 1; ++ + spin_unlock(&wdt_lock); + } + +@@ -329,6 +330,8 @@ static int __devinit mpcore_wdt_probe(st + struct mpcore_wdt *wdt; + struct resource *res; + int ret; ++ unsigned long count; ++ u64 waitjiffies; + + /* We only accept one device, and it must have an id of -1 */ + if (dev->id != -1) +@@ -375,6 +378,22 @@ static int __devinit mpcore_wdt_probe(st + goto err_irq; + } + ++ waitjiffies = get_jiffies_64() + 1; ++ while (get_jiffies_64() < waitjiffies) ++ udelay(10); ++ ++ waitjiffies += 5; ++ ++ __raw_writel(0x00000001, wdt->base + TWD_WDOG_CONTROL); ++ __raw_writel(0xFFFFFFFFU, wdt->base + TWD_WDOG_LOAD); ++ ++ while (get_jiffies_64() < waitjiffies) ++ udelay(10); ++ ++ count = __raw_readl(wdt->base + TWD_WDOG_COUNTER); ++ ++ wdt->timer_rate = (0xFFFFFFFFU - count) * (HZ / 5); ++ + mpcore_wdt_stop(wdt); + platform_set_drvdata(dev, wdt); + mpcore_wdt_dev = dev; |