120 lines
2.2 KiB
C
120 lines
2.2 KiB
C
// SPDX-License-Identifier: GPL-2.0+
|
|
/*
|
|
* Copyright 2017 Google, Inc
|
|
*/
|
|
|
|
#include <common.h>
|
|
#include <dm.h>
|
|
#include <errno.h>
|
|
#include <wdt.h>
|
|
#include <dm/device-internal.h>
|
|
#include <dm/lists.h>
|
|
|
|
DECLARE_GLOBAL_DATA_PTR;
|
|
|
|
int wdt_start(struct udevice *dev, u64 timeout_ms, ulong flags)
|
|
{
|
|
const struct wdt_ops *ops = device_get_ops(dev);
|
|
|
|
if (!ops->start)
|
|
return -ENOSYS;
|
|
|
|
return ops->start(dev, timeout_ms, flags);
|
|
}
|
|
|
|
int wdt_stop(struct udevice *dev)
|
|
{
|
|
const struct wdt_ops *ops = device_get_ops(dev);
|
|
|
|
if (!ops->stop)
|
|
return -ENOSYS;
|
|
|
|
return ops->stop(dev);
|
|
}
|
|
|
|
int wdt_reset(struct udevice *dev)
|
|
{
|
|
const struct wdt_ops *ops = device_get_ops(dev);
|
|
|
|
if (!ops->reset)
|
|
return -ENOSYS;
|
|
|
|
return ops->reset(dev);
|
|
}
|
|
|
|
int wdt_expire_now(struct udevice *dev, ulong flags)
|
|
{
|
|
int ret = 0;
|
|
const struct wdt_ops *ops;
|
|
|
|
debug("WDT Resetting: %lu\n", flags);
|
|
ops = device_get_ops(dev);
|
|
if (ops->expire_now) {
|
|
return ops->expire_now(dev, flags);
|
|
} else {
|
|
if (!ops->start)
|
|
return -ENOSYS;
|
|
|
|
ret = ops->start(dev, 1, flags);
|
|
if (ret < 0)
|
|
return ret;
|
|
|
|
hang();
|
|
}
|
|
|
|
return ret;
|
|
}
|
|
|
|
#if defined(CONFIG_WATCHDOG)
|
|
/*
|
|
* Called by macro WATCHDOG_RESET. This function be called *very* early,
|
|
* so we need to make sure, that the watchdog driver is ready before using
|
|
* it in this function.
|
|
*/
|
|
void watchdog_reset(void)
|
|
{
|
|
static ulong next_reset;
|
|
ulong now;
|
|
|
|
/* Exit if GD is not ready or watchdog is not initialized yet */
|
|
if (!gd || !(gd->flags & GD_FLG_WDT_READY))
|
|
return;
|
|
|
|
/* Do not reset the watchdog too often */
|
|
now = get_timer(0);
|
|
if (now > next_reset) {
|
|
next_reset = now + 1000; /* reset every 1000ms */
|
|
wdt_reset(gd->watchdog_dev);
|
|
}
|
|
}
|
|
#endif
|
|
|
|
static int wdt_post_bind(struct udevice *dev)
|
|
{
|
|
#if defined(CONFIG_NEEDS_MANUAL_RELOC)
|
|
struct wdt_ops *ops = (struct wdt_ops *)device_get_ops(dev);
|
|
static int reloc_done;
|
|
|
|
if (!reloc_done) {
|
|
if (ops->start)
|
|
ops->start += gd->reloc_off;
|
|
if (ops->stop)
|
|
ops->stop += gd->reloc_off;
|
|
if (ops->reset)
|
|
ops->reset += gd->reloc_off;
|
|
if (ops->expire_now)
|
|
ops->expire_now += gd->reloc_off;
|
|
|
|
reloc_done++;
|
|
}
|
|
#endif
|
|
return 0;
|
|
}
|
|
|
|
UCLASS_DRIVER(wdt) = {
|
|
.id = UCLASS_WDT,
|
|
.name = "watchdog",
|
|
.flags = DM_UC_FLAG_SEQ_ALIAS,
|
|
.post_bind = wdt_post_bind,
|
|
};
|