Skip to contentSkip to conversation

watchdog: armada_37xx: Probe driver also when watchdog is already running

PATCH In review Pali Rohár 3 participants 4 messages Feb 23, 2022 – Mar 8, 2022 Watchdog device drivers

lore
Share & tools
lore
#0 lore raw

PATCH 1/1 watchdog: armada_37xx: Probe driver also when watchdog is already running

If Armada 37xx watchdog is started before U-Boot then CNTR_CTRL_ACTIVE bit is set, U-Boot armada-37xx-wdt.c driver fails to initialize and so U-Boot is unable to use or kick this watchdog.

Do not check for CNTR_CTRL_ACTIVE bit and always initialize watchdog. Same behavior is implemented in Linux kernel driver.

This change allows to activate watchdog in firmware which loads U-Boot.

---
 drivers/watchdog/armada-37xx-wdt.c | 17 +++--------------
 1 file changed, 3 insertions(+), 14 deletions(-)
drivers/watchdog/armada-37xx-wdt.c +3 -14
index 2e119b9b5aad..bacebbc7926a 100644
@@ -58,13 +58,11 @@ static void counter_disable(struct a37xx_wdt *priv, int id)
 	clrbits_le32(priv->reg + CNTR_CTRL(id), CNTR_CTRL_ENABLE);
 }
 
-static int init_counter(struct a37xx_wdt *priv, int id, u32 mode, u32 trig_src)
+static void init_counter(struct a37xx_wdt *priv, int id, u32 mode, u32 trig_src)
 {
 	u32 reg;
 
 	reg = readl(priv->reg + CNTR_CTRL(id));
-	if (reg & CNTR_CTRL_ACTIVE)
-		return -EBUSY;
 
 	reg &= ~(CNTR_CTRL_MODE_MASK | CNTR_CTRL_PRESCALE_MASK |
 		 CNTR_CTRL_TRIG_SRC_MASK);
@@ -79,8 +77,6 @@ static int init_counter(struct a37xx_wdt *priv, int id, u32 mode, u32 trig_src)
 	reg |= trig_src;
 
 	writel(reg, priv->reg + CNTR_CTRL(id));
-
-	return 0;
 }
 
 static int a37xx_wdt_reset(struct udevice *dev)
@@ -116,16 +112,9 @@ static int a37xx_wdt_expire_now(struct udevice *dev, ulong flags)
 static int a37xx_wdt_start(struct udevice *dev, u64 ms, ulong flags)
 {
 	struct a37xx_wdt *priv = dev_get_priv(dev);
-	int err;
-
-	err = init_counter(priv, 0, CNTR_CTRL_MODE_ONESHOT, 0);
-	if (err < 0)
-		return err;
 
-	err = init_counter(priv, 1, CNTR_CTRL_MODE_HWSIG,
-			   CNTR_CTRL_TRIG_SRC_PREV_CNTR);
-	if (err < 0)
-		return err;
+	init_counter(priv, 0, CNTR_CTRL_MODE_ONESHOT, 0);
+	init_counter(priv, 1, CNTR_CTRL_MODE_HWSIG, CNTR_CTRL_TRIG_SRC_PREV_CNTR);
 
 	priv->timeout = ms * priv->clk_rate / 1000 / CNTR_CTRL_PRESCALE_MIN;
 
Signature · 1 line
2.20.1
Reviewed-by on v1 1/1
#1 lore raw
Quoted 10 lines · On Wed, 23 Feb 2022 14:21:40 +0100 Pali Rohár <[email protected]> wrote:

If Armada 37xx watchdog is started before U-Boot then CNTR_CTRL_ACTIVE bit is set, U-Boot armada-37xx-wdt.c driver fails to initialize and so U-Boot is unable to use or kick this watchdog.

Do not check for CNTR_CTRL_ACTIVE bit and always initialize watchdog. Same behavior is implemented in Linux kernel driver.

This change allows to activate watchdog in firmware which loads U-Boot.

Reviewed-by on v1 1/1
#2 lore raw
In reply to Pali Rohár
Quoted 10 lines · Pali Rohár

If Armada 37xx watchdog is started before U-Boot then CNTR_CTRL_ACTIVE bit is set, U-Boot armada-37xx-wdt.c driver fails to initialize and so U-Boot is unable to use or kick this watchdog.

Do not check for CNTR_CTRL_ACTIVE bit and always initialize watchdog. Same behavior is implemented in Linux kernel driver.

This change allows to activate watchdog in firmware which loads U-Boot.

Thanks,
Stefan

Quoted 41 lines
---
  drivers/watchdog/armada-37xx-wdt.c | 17 +++--------------
  1 file changed, 3 insertions(+), 14 deletions(-)
drivers/watchdog/armada-37xx-wdt.c +1 -10
index 2e119b9b5aad..bacebbc7926a 100644
@@ -58,13 +58,11 @@ static void counter_disable(struct a37xx_wdt *priv, int id)
  	clrbits_le32(priv->reg + CNTR_CTRL(id), CNTR_CTRL_ENABLE);
  }
 
-static int init_counter(struct a37xx_wdt *priv, int id, u32 mode, u32 trig_src)
+static void init_counter(struct a37xx_wdt *priv, int id, u32 mode, u32 trig_src)
  {
  	u32 reg;
 
  	reg = readl(priv->reg + CNTR_CTRL(id));
-	if (reg & CNTR_CTRL_ACTIVE)
-		return -EBUSY;
 
  	reg &= ~(CNTR_CTRL_MODE_MASK | CNTR_CTRL_PRESCALE_MASK |
  		 CNTR_CTRL_TRIG_SRC_MASK);
@@ -79,8 +77,6 @@ static int init_counter(struct a37xx_wdt *priv, int id, u32 mode, u32 trig_src)
  	reg |= trig_src;
 
  	writel(reg, priv->reg + CNTR_CTRL(id));
-
-	return 0;
  }
 
  static int a37xx_wdt_reset(struct udevice *dev)
@@ -116,16 +112,9 @@ static int a37xx_wdt_expire_now(struct udevice *dev, ulong flags)
  static int a37xx_wdt_start(struct udevice *dev, u64 ms, ulong flags)
  {
  	struct a37xx_wdt *priv = dev_get_priv(dev);
-	int err;
-
-	err = init_counter(priv, 0, CNTR_CTRL_MODE_ONESHOT, 0);
-	if (err < 0)
-		return err;

drivers/watchdog/armada-37xx-wdt.c static int a37xx_wdt_expire_now(struct udevice *dev, ulong flags) · line 120

Quoted 10 lines
drivers/watchdog/armada-37xx-wdt.c +2 -4
 
-	err = init_counter(priv, 1, CNTR_CTRL_MODE_HWSIG,
-			   CNTR_CTRL_TRIG_SRC_PREV_CNTR);
-	if (err < 0)
-		return err;
+	init_counter(priv, 0, CNTR_CTRL_MODE_ONESHOT, 0);
+	init_counter(priv, 1, CNTR_CTRL_MODE_HWSIG, CNTR_CTRL_TRIG_SRC_PREV_CNTR);
 
  	priv->timeout = ms * priv->clk_rate / 1000 / CNTR_CTRL_PRESCALE_MIN;
 

Viele Grüße,
Stefan Roese

Signature · 3 lines
DENX Software Engineering GmbH,      Managing Director: Wolfgang Denk
HRB 165235 Munich, Office: Kirchenstr.5, D-82194 Groebenzell, Germany
Phone: (+49)-8142-66989-51 Fax: (+49)-8142-66989-80 Email: [email protected]
#3 lore raw
In reply to Pali Rohár
Quoted 10 lines · Pali Rohár

If Armada 37xx watchdog is started before U-Boot then CNTR_CTRL_ACTIVE bit is set, U-Boot armada-37xx-wdt.c driver fails to initialize and so U-Boot is unable to use or kick this watchdog.

Do not check for CNTR_CTRL_ACTIVE bit and always initialize watchdog. Same behavior is implemented in Linux kernel driver.

This change allows to activate watchdog in firmware which loads U-Boot.

Applied to u-boot-watchdog/master

Thanks,
Stefan

Quoted 41 lines
---
  drivers/watchdog/armada-37xx-wdt.c | 17 +++--------------
  1 file changed, 3 insertions(+), 14 deletions(-)
drivers/watchdog/armada-37xx-wdt.c +1 -10
index 2e119b9b5aad..bacebbc7926a 100644
@@ -58,13 +58,11 @@ static void counter_disable(struct a37xx_wdt *priv, int id)
  	clrbits_le32(priv->reg + CNTR_CTRL(id), CNTR_CTRL_ENABLE);
  }
 
-static int init_counter(struct a37xx_wdt *priv, int id, u32 mode, u32 trig_src)
+static void init_counter(struct a37xx_wdt *priv, int id, u32 mode, u32 trig_src)
  {
  	u32 reg;
 
  	reg = readl(priv->reg + CNTR_CTRL(id));
-	if (reg & CNTR_CTRL_ACTIVE)
-		return -EBUSY;
 
  	reg &= ~(CNTR_CTRL_MODE_MASK | CNTR_CTRL_PRESCALE_MASK |
  		 CNTR_CTRL_TRIG_SRC_MASK);
@@ -79,8 +77,6 @@ static int init_counter(struct a37xx_wdt *priv, int id, u32 mode, u32 trig_src)
  	reg |= trig_src;
 
  	writel(reg, priv->reg + CNTR_CTRL(id));
-
-	return 0;
  }
 
  static int a37xx_wdt_reset(struct udevice *dev)
@@ -116,16 +112,9 @@ static int a37xx_wdt_expire_now(struct udevice *dev, ulong flags)
  static int a37xx_wdt_start(struct udevice *dev, u64 ms, ulong flags)
  {
  	struct a37xx_wdt *priv = dev_get_priv(dev);
-	int err;
-
-	err = init_counter(priv, 0, CNTR_CTRL_MODE_ONESHOT, 0);
-	if (err < 0)
-		return err;

drivers/watchdog/armada-37xx-wdt.c static int a37xx_wdt_expire_now(struct udevice *dev, ulong flags) · line 120

Quoted 10 lines
drivers/watchdog/armada-37xx-wdt.c +2 -4
 
-	err = init_counter(priv, 1, CNTR_CTRL_MODE_HWSIG,
-			   CNTR_CTRL_TRIG_SRC_PREV_CNTR);
-	if (err < 0)
-		return err;
+	init_counter(priv, 0, CNTR_CTRL_MODE_ONESHOT, 0);
+	init_counter(priv, 1, CNTR_CTRL_MODE_HWSIG, CNTR_CTRL_TRIG_SRC_PREV_CNTR);
 
  	priv->timeout = ms * priv->clk_rate / 1000 / CNTR_CTRL_PRESCALE_MIN;
 

Viele Grüße,
Stefan Roese

Signature · 3 lines
DENX Software Engineering GmbH,      Managing Director: Wolfgang Denk
HRB 165235 Munich, Office: Kirchenstr.5, D-82194 Groebenzell, Germany
Phone: (+49)-8142-66989-51 Fax: (+49)-8142-66989-80 Email: [email protected]