watchdog: wdt-uclass.c: introduce struct wdt_priv
As preparation for having the wdt-uclass provided watchdog_reset() function handle all DM watchdog devices, and not just the first such, introduce a uclass-owned struct to hold the reset_period and next_reset, so these become per-device instead of being static variables. No functional change intended. Reviewed-by: Simon Glass <sjg@chromium.org> Reviewed-by: Stefan Roese <sr@denx.de> Signed-off-by: Rasmus Villemoes <rasmus.villemoes@prevas.dk>
This commit is contained in:

committed by
Stefan Roese

parent
8967ebb653
commit
6d24dc89f0
@@ -20,15 +20,24 @@ DECLARE_GLOBAL_DATA_PTR;
|
|||||||
|
|
||||||
#define WATCHDOG_TIMEOUT_SECS (CONFIG_WATCHDOG_TIMEOUT_MSECS / 1000)
|
#define WATCHDOG_TIMEOUT_SECS (CONFIG_WATCHDOG_TIMEOUT_MSECS / 1000)
|
||||||
|
|
||||||
/*
|
struct wdt_priv {
|
||||||
* Reset every 1000ms, or however often is required as indicated by a
|
/* Timeout, in seconds, to configure this device to. */
|
||||||
* hw_margin_ms property.
|
u32 timeout;
|
||||||
*/
|
/*
|
||||||
static ulong reset_period = 1000;
|
* Time, in milliseconds, between calling the device's ->reset()
|
||||||
|
* method from watchdog_reset().
|
||||||
|
*/
|
||||||
|
ulong reset_period;
|
||||||
|
/*
|
||||||
|
* Next time (as returned by get_timer(0)) to call
|
||||||
|
* ->reset().
|
||||||
|
*/
|
||||||
|
ulong next_reset;
|
||||||
|
};
|
||||||
|
|
||||||
int initr_watchdog(void)
|
int initr_watchdog(void)
|
||||||
{
|
{
|
||||||
u32 timeout = WATCHDOG_TIMEOUT_SECS;
|
struct wdt_priv *priv;
|
||||||
int ret;
|
int ret;
|
||||||
|
|
||||||
/*
|
/*
|
||||||
@@ -44,28 +53,21 @@ int initr_watchdog(void)
|
|||||||
return 0;
|
return 0;
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
priv = dev_get_uclass_priv(gd->watchdog_dev);
|
||||||
if (CONFIG_IS_ENABLED(OF_CONTROL) && !CONFIG_IS_ENABLED(OF_PLATDATA)) {
|
|
||||||
timeout = dev_read_u32_default(gd->watchdog_dev, "timeout-sec",
|
|
||||||
WATCHDOG_TIMEOUT_SECS);
|
|
||||||
reset_period = dev_read_u32_default(gd->watchdog_dev,
|
|
||||||
"hw_margin_ms",
|
|
||||||
4 * reset_period) / 4;
|
|
||||||
}
|
|
||||||
|
|
||||||
if (!IS_ENABLED(CONFIG_WATCHDOG_AUTOSTART)) {
|
if (!IS_ENABLED(CONFIG_WATCHDOG_AUTOSTART)) {
|
||||||
printf("WDT: Not starting\n");
|
printf("WDT: Not starting\n");
|
||||||
return 0;
|
return 0;
|
||||||
}
|
}
|
||||||
|
|
||||||
ret = wdt_start(gd->watchdog_dev, timeout * 1000, 0);
|
ret = wdt_start(gd->watchdog_dev, priv->timeout * 1000, 0);
|
||||||
if (ret != 0) {
|
if (ret != 0) {
|
||||||
printf("WDT: Failed to start\n");
|
printf("WDT: Failed to start\n");
|
||||||
return 0;
|
return 0;
|
||||||
}
|
}
|
||||||
|
|
||||||
printf("WDT: Started with%s servicing (%ds timeout)\n",
|
printf("WDT: Started with%s servicing (%ds timeout)\n",
|
||||||
IS_ENABLED(CONFIG_WATCHDOG) ? "" : "out", timeout);
|
IS_ENABLED(CONFIG_WATCHDOG) ? "" : "out", priv->timeout);
|
||||||
|
|
||||||
return 0;
|
return 0;
|
||||||
}
|
}
|
||||||
@@ -139,18 +141,21 @@ int wdt_expire_now(struct udevice *dev, ulong flags)
|
|||||||
*/
|
*/
|
||||||
void watchdog_reset(void)
|
void watchdog_reset(void)
|
||||||
{
|
{
|
||||||
static ulong next_reset;
|
struct wdt_priv *priv;
|
||||||
|
struct udevice *dev;
|
||||||
ulong now;
|
ulong now;
|
||||||
|
|
||||||
/* Exit if GD is not ready or watchdog is not initialized yet */
|
/* Exit if GD is not ready or watchdog is not initialized yet */
|
||||||
if (!gd || !(gd->flags & GD_FLG_WDT_READY))
|
if (!gd || !(gd->flags & GD_FLG_WDT_READY))
|
||||||
return;
|
return;
|
||||||
|
|
||||||
|
dev = gd->watchdog_dev;
|
||||||
|
priv = dev_get_uclass_priv(dev);
|
||||||
/* Do not reset the watchdog too often */
|
/* Do not reset the watchdog too often */
|
||||||
now = get_timer(0);
|
now = get_timer(0);
|
||||||
if (time_after_eq(now, next_reset)) {
|
if (time_after_eq(now, priv->next_reset)) {
|
||||||
next_reset = now + reset_period;
|
priv->next_reset = now + priv->reset_period;
|
||||||
wdt_reset(gd->watchdog_dev);
|
wdt_reset(dev);
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
#endif
|
#endif
|
||||||
@@ -177,9 +182,38 @@ static int wdt_post_bind(struct udevice *dev)
|
|||||||
return 0;
|
return 0;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
static int wdt_pre_probe(struct udevice *dev)
|
||||||
|
{
|
||||||
|
u32 timeout = WATCHDOG_TIMEOUT_SECS;
|
||||||
|
/*
|
||||||
|
* Reset every 1000ms, or however often is required as
|
||||||
|
* indicated by a hw_margin_ms property.
|
||||||
|
*/
|
||||||
|
ulong reset_period = 1000;
|
||||||
|
struct wdt_priv *priv;
|
||||||
|
|
||||||
|
if (CONFIG_IS_ENABLED(OF_CONTROL) && !CONFIG_IS_ENABLED(OF_PLATDATA)) {
|
||||||
|
timeout = dev_read_u32_default(dev, "timeout-sec", timeout);
|
||||||
|
reset_period = dev_read_u32_default(dev, "hw_margin_ms",
|
||||||
|
4 * reset_period) / 4;
|
||||||
|
}
|
||||||
|
priv = dev_get_uclass_priv(dev);
|
||||||
|
priv->timeout = timeout;
|
||||||
|
priv->reset_period = reset_period;
|
||||||
|
/*
|
||||||
|
* Pretend this device was last reset "long" ago so the first
|
||||||
|
* watchdog_reset will actually call its ->reset method.
|
||||||
|
*/
|
||||||
|
priv->next_reset = get_timer(0);
|
||||||
|
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
|
||||||
UCLASS_DRIVER(wdt) = {
|
UCLASS_DRIVER(wdt) = {
|
||||||
.id = UCLASS_WDT,
|
.id = UCLASS_WDT,
|
||||||
.name = "watchdog",
|
.name = "watchdog",
|
||||||
.flags = DM_UC_FLAG_SEQ_ALIAS,
|
.flags = DM_UC_FLAG_SEQ_ALIAS,
|
||||||
.post_bind = wdt_post_bind,
|
.post_bind = wdt_post_bind,
|
||||||
|
.pre_probe = wdt_pre_probe,
|
||||||
|
.per_device_auto = sizeof(struct wdt_priv),
|
||||||
};
|
};
|
||||||
|
Reference in New Issue
Block a user