diff --git a/target/linux/cns3xxx/patches-4.9/020-watchdog_support.patch b/target/linux/cns3xxx/patches-4.9/020-watchdog_support.patch index 8707bf9b6c..4f9f3e6465 100644 --- a/target/linux/cns3xxx/patches-4.9/020-watchdog_support.patch +++ b/target/linux/cns3xxx/patches-4.9/020-watchdog_support.patch @@ -30,13 +30,14 @@ Signed-off-by: Felix Fietkau obj-$(CONFIG_SAMA5D4_WATCHDOG) += sama5d4_wdt.o --- /dev/null +++ b/drivers/watchdog/mpcore_wdt.c -@@ -0,0 +1,117 @@ +@@ -0,0 +1,118 @@ +/* + * Watchdog driver for ARM MPcore + * + * Copyright (C) 2017 Felix Fietkau + */ + ++#include +#include +#include +#include @@ -52,10 +53,7 @@ Signed-off-by: Felix Fietkau + static int perturb; + u32 count; + -+ count = ioread32(wdt_base + TWD_WDOG_COUNTER); -+ count = (~0U - count) * HZ / 5; -+ count /= 256; /* prescale */ -+ count *= wdt_timeout; ++ count = (twd_timer_get_rate() / 256) * wdt_timeout; + + /* Reload register needs a different value on each refresh */ + count += perturb; @@ -118,6 +116,9 @@ Signed-off-by: Felix Fietkau +static int mpcore_wdt_probe(struct platform_device *pdev) +{ + struct resource *res; ++ unsigned long rate = twd_timer_get_rate(); ++ ++ pr_info("MPCore WD init. clockrate: %u prescaler: %u countrate: %u timeout: %us\n", rate, 256, rate / 256, wdt_timeout); + + res = platform_get_resource(pdev, IORESOURCE_MEM, 0); + if (!res) @@ -148,3 +149,37 @@ Signed-off-by: Felix Fietkau +module_platform_driver(mpcore_wdt_driver); +MODULE_AUTHOR("Felix Fietkau "); +MODULE_LICENSE("GPL"); +--- a/arch/arm/include/asm/smp_twd.h ++++ b/arch/arm/include/asm/smp_twd.h +@@ -33,5 +33,6 @@ struct twd_local_timer name __initdata = + }; + + int twd_local_timer_register(struct twd_local_timer *); ++unsigned long twd_timer_get_rate(void); + + #endif +--- a/arch/arm/kernel/smp_twd.c ++++ b/arch/arm/kernel/smp_twd.c +@@ -15,6 +15,7 @@ + #include + #include + #include ++#include + #include + #include + #include +@@ -380,6 +381,14 @@ int __init twd_local_timer_register(stru + return twd_local_timer_common_register(NULL); + } + ++/* Needed by mpcore_wdt */ ++unsigned long twd_timer_get_rate(void) ++{ ++ return twd_timer_rate; ++} ++EXPORT_SYMBOL_GPL(twd_timer_get_rate); ++ ++ + #ifdef CONFIG_OF + static int __init twd_local_timer_of_register(struct device_node *np) + {