mirror of
https://github.com/brain-hackers/u-boot-brain
synced 2024-06-09 23:36:03 +09:00
b8050511c6
This is a generic implementation. Add CONFIG_SYSRESET_CMD_POWEROFF to signal when we need it. Enable it from the STPMIC1 config and in sandbox. The config flag is transitionary, that is it can be removed after all poweroff implementations use sysreset, and just have CMD_POWEROFF depend on sysreset. Signed-off-by: Urja Rannikko <urjaman@gmail.com> Reviewed-by: Patrice Chotard <patrice.chotard@st.com> Reviewed-by: Patrick Delaunay <patrick.delaunay@st.com> Tested-by: Patrick Delaunay <patrick.delaunay@st.com>
159 lines
2.8 KiB
C
159 lines
2.8 KiB
C
// SPDX-License-Identifier: GPL-2.0+
|
|
/*
|
|
* Copyright (C) 2015 Google, Inc
|
|
* Written by Simon Glass <sjg@chromium.org>
|
|
*/
|
|
|
|
#define LOG_CATEGORY UCLASS_SYSRESET
|
|
|
|
#include <common.h>
|
|
#include <sysreset.h>
|
|
#include <dm.h>
|
|
#include <errno.h>
|
|
#include <regmap.h>
|
|
#include <dm/device-internal.h>
|
|
#include <dm/lists.h>
|
|
#include <dm/root.h>
|
|
#include <linux/err.h>
|
|
|
|
int sysreset_request(struct udevice *dev, enum sysreset_t type)
|
|
{
|
|
struct sysreset_ops *ops = sysreset_get_ops(dev);
|
|
|
|
if (!ops->request)
|
|
return -ENOSYS;
|
|
|
|
return ops->request(dev, type);
|
|
}
|
|
|
|
int sysreset_get_status(struct udevice *dev, char *buf, int size)
|
|
{
|
|
struct sysreset_ops *ops = sysreset_get_ops(dev);
|
|
|
|
if (!ops->get_status)
|
|
return -ENOSYS;
|
|
|
|
return ops->get_status(dev, buf, size);
|
|
}
|
|
|
|
int sysreset_get_last(struct udevice *dev)
|
|
{
|
|
struct sysreset_ops *ops = sysreset_get_ops(dev);
|
|
|
|
if (!ops->get_last)
|
|
return -ENOSYS;
|
|
|
|
return ops->get_last(dev);
|
|
}
|
|
|
|
int sysreset_walk(enum sysreset_t type)
|
|
{
|
|
struct udevice *dev;
|
|
int ret = -ENOSYS;
|
|
|
|
while (ret != -EINPROGRESS && type < SYSRESET_COUNT) {
|
|
for (uclass_first_device(UCLASS_SYSRESET, &dev);
|
|
dev;
|
|
uclass_next_device(&dev)) {
|
|
ret = sysreset_request(dev, type);
|
|
if (ret == -EINPROGRESS)
|
|
break;
|
|
}
|
|
type++;
|
|
}
|
|
|
|
return ret;
|
|
}
|
|
|
|
int sysreset_get_last_walk(void)
|
|
{
|
|
struct udevice *dev;
|
|
int value = -ENOENT;
|
|
|
|
for (uclass_first_device(UCLASS_SYSRESET, &dev);
|
|
dev;
|
|
uclass_next_device(&dev)) {
|
|
int ret;
|
|
|
|
ret = sysreset_get_last(dev);
|
|
if (ret >= 0) {
|
|
value = ret;
|
|
break;
|
|
}
|
|
}
|
|
|
|
return value;
|
|
}
|
|
|
|
void sysreset_walk_halt(enum sysreset_t type)
|
|
{
|
|
int ret;
|
|
|
|
ret = sysreset_walk(type);
|
|
|
|
/* Wait for the reset to take effect */
|
|
if (ret == -EINPROGRESS)
|
|
mdelay(100);
|
|
|
|
/* Still no reset? Give up */
|
|
log_err("System reset not supported on this platform\n");
|
|
hang();
|
|
}
|
|
|
|
/**
|
|
* reset_cpu() - calls sysreset_walk(SYSRESET_WARM)
|
|
*/
|
|
void reset_cpu(ulong addr)
|
|
{
|
|
sysreset_walk_halt(SYSRESET_WARM);
|
|
}
|
|
|
|
|
|
int do_reset(cmd_tbl_t *cmdtp, int flag, int argc, char * const argv[])
|
|
{
|
|
printf("resetting ...\n");
|
|
|
|
sysreset_walk_halt(SYSRESET_COLD);
|
|
|
|
return 0;
|
|
}
|
|
|
|
#if IS_ENABLED(CONFIG_SYSRESET_CMD_POWEROFF)
|
|
int do_poweroff(cmd_tbl_t *cmdtp, int flag, int argc, char * const argv[])
|
|
{
|
|
int ret;
|
|
|
|
puts("poweroff ...\n");
|
|
mdelay(100);
|
|
|
|
ret = sysreset_walk(SYSRESET_POWER_OFF);
|
|
|
|
if (ret == -EINPROGRESS)
|
|
mdelay(1000);
|
|
|
|
/*NOTREACHED when power off*/
|
|
return CMD_RET_FAILURE;
|
|
}
|
|
#endif
|
|
|
|
static int sysreset_post_bind(struct udevice *dev)
|
|
{
|
|
#if defined(CONFIG_NEEDS_MANUAL_RELOC)
|
|
struct sysreset_ops *ops = sysreset_get_ops(dev);
|
|
static int reloc_done;
|
|
|
|
if (!reloc_done) {
|
|
if (ops->request)
|
|
ops->request += gd->reloc_off;
|
|
reloc_done++;
|
|
}
|
|
#endif
|
|
return 0;
|
|
}
|
|
|
|
UCLASS_DRIVER(sysreset) = {
|
|
.id = UCLASS_SYSRESET,
|
|
.name = "sysreset",
|
|
.post_bind = sysreset_post_bind,
|
|
};
|