@@ -54,6 +54,7 @@
#define IMX2_WDT_DEFAULT_TIME 60 /* in seconds */
#define WDOG_SEC_TO_COUNT(s) ((s * 2 - 1) << 8)
+#define WDOG_COUNT_TO_SEC(c) ((((c) >> 8) + 1) / 2)
#define IMX2_WDT_STATUS_OPEN 0
#define IMX2_WDT_STATUS_STARTED 1
@@ -120,6 +121,27 @@ static void imx2_wdt_timer_ping(unsigned long arg)
mod_timer(&imx2_wdt.timer, jiffies + imx2_wdt.timeout * HZ / 2);
}
+static inline void imx2_wdt_ping_if_active(void)
+{
+ u16 val = __raw_readw(imx2_wdt.base + IMX2_WDT_WCR);
+
+ if (val & IMX2_WDT_WCR_WDE) {
+ /* Must enable the clock, wdog service doesn't work otherwise */
+ clk_prepare_enable(imx2_wdt.clk);
+
+ set_bit(IMX2_WDT_STATUS_STARTED, &imx2_wdt.status);
+ imx2_wdt.timeout = WDOG_COUNT_TO_SEC(val);
+ if (imx2_wdt.timeout < 2) {
+ imx2_wdt.timeout = 2;
+ /* Set new watchdog time-out value */
+ val &= ~IMX2_WDT_WCR_WT;
+ val |= WDOG_SEC_TO_COUNT(imx2_wdt.timeout);
+ __raw_writew(val, imx2_wdt.base + IMX2_WDT_WCR);
+ }
+ imx2_wdt_timer_ping(0);
+ }
+}
+
static void imx2_wdt_start(void)
{
if (!test_and_set_bit(IMX2_WDT_STATUS_STARTED, &imx2_wdt.status)) {
@@ -283,6 +305,8 @@ static int __init imx2_wdt_probe(struct platform_device *pdev)
if (ret)
goto fail;
+ imx2_wdt_ping_if_active();
+
dev_info(&pdev->dev,
"IMX2+ Watchdog Timer enabled. timeout=%ds (nowayout=%d)\n",
imx2_wdt.timeout, nowayout);
If the watchdog is already enabled (e.g. started by the boot loader), we need to handle this case properly and start reloading the watchdog time-out counter as frequently as needed. Signed-off-by: Anatolij Gustschin <agust@denx.de> Cc: Wolfram Sang <wsa@the-dreams.de> Cc: Wim Van Sebroeck <wim@iguana.be> --- drivers/watchdog/imx2_wdt.c | 24 ++++++++++++++++++++++++ 1 file changed, 24 insertions(+)