183d290c5STom Rini // SPDX-License-Identifier: GPL-2.0+
2b25732c2SMax Filippov /*
3b25732c2SMax Filippov  * Copyright (C) 2015 Google, Inc
4b25732c2SMax Filippov  * Written by Simon Glass <sjg@chromium.org>
5b25732c2SMax Filippov  */
6b25732c2SMax Filippov 
7b25732c2SMax Filippov #include <common.h>
8b25732c2SMax Filippov #include <sysreset.h>
9b25732c2SMax Filippov #include <dm.h>
10b25732c2SMax Filippov #include <errno.h>
11b25732c2SMax Filippov #include <regmap.h>
12b25732c2SMax Filippov #include <dm/device-internal.h>
13b25732c2SMax Filippov #include <dm/lists.h>
14b25732c2SMax Filippov #include <dm/root.h>
15b25732c2SMax Filippov #include <linux/err.h>
16b25732c2SMax Filippov 
17b25732c2SMax Filippov int sysreset_request(struct udevice *dev, enum sysreset_t type)
18b25732c2SMax Filippov {
19b25732c2SMax Filippov 	struct sysreset_ops *ops = sysreset_get_ops(dev);
20b25732c2SMax Filippov 
21b25732c2SMax Filippov 	if (!ops->request)
22b25732c2SMax Filippov 		return -ENOSYS;
23b25732c2SMax Filippov 
24b25732c2SMax Filippov 	return ops->request(dev, type);
25b25732c2SMax Filippov }
26b25732c2SMax Filippov 
27b25732c2SMax Filippov int sysreset_walk(enum sysreset_t type)
28b25732c2SMax Filippov {
29b25732c2SMax Filippov 	struct udevice *dev;
30b25732c2SMax Filippov 	int ret = -ENOSYS;
31b25732c2SMax Filippov 
32b25732c2SMax Filippov 	while (ret != -EINPROGRESS && type < SYSRESET_COUNT) {
33b25732c2SMax Filippov 		for (uclass_first_device(UCLASS_SYSRESET, &dev);
34b25732c2SMax Filippov 		     dev;
35b25732c2SMax Filippov 		     uclass_next_device(&dev)) {
36b25732c2SMax Filippov 			ret = sysreset_request(dev, type);
37b25732c2SMax Filippov 			if (ret == -EINPROGRESS)
38b25732c2SMax Filippov 				break;
39b25732c2SMax Filippov 		}
40b25732c2SMax Filippov 		type++;
41b25732c2SMax Filippov 	}
42b25732c2SMax Filippov 
43b25732c2SMax Filippov 	return ret;
44b25732c2SMax Filippov }
45b25732c2SMax Filippov 
46b25732c2SMax Filippov void sysreset_walk_halt(enum sysreset_t type)
47b25732c2SMax Filippov {
48b25732c2SMax Filippov 	int ret;
49b25732c2SMax Filippov 
50b25732c2SMax Filippov 	ret = sysreset_walk(type);
51b25732c2SMax Filippov 
52b25732c2SMax Filippov 	/* Wait for the reset to take effect */
53b25732c2SMax Filippov 	if (ret == -EINPROGRESS)
54b25732c2SMax Filippov 		mdelay(100);
55b25732c2SMax Filippov 
56b25732c2SMax Filippov 	/* Still no reset? Give up */
57b25732c2SMax Filippov 	debug("System reset not supported on this platform\n");
58b25732c2SMax Filippov 	hang();
59b25732c2SMax Filippov }
60b25732c2SMax Filippov 
61b25732c2SMax Filippov /**
62b25732c2SMax Filippov  * reset_cpu() - calls sysreset_walk(SYSRESET_WARM)
63b25732c2SMax Filippov  */
64b25732c2SMax Filippov void reset_cpu(ulong addr)
65b25732c2SMax Filippov {
66b25732c2SMax Filippov 	sysreset_walk_halt(SYSRESET_WARM);
67b25732c2SMax Filippov }
68b25732c2SMax Filippov 
69b25732c2SMax Filippov 
70b25732c2SMax Filippov int do_reset(cmd_tbl_t *cmdtp, int flag, int argc, char * const argv[])
71b25732c2SMax Filippov {
72*406be398SBin Meng 	printf("resetting ...\n");
73*406be398SBin Meng 
74b53f6992SPhilipp Tomsich 	sysreset_walk_halt(SYSRESET_COLD);
75b25732c2SMax Filippov 
76b25732c2SMax Filippov 	return 0;
77b25732c2SMax Filippov }
78b25732c2SMax Filippov 
79758de97bSMichal Simek static int sysreset_post_bind(struct udevice *dev)
80758de97bSMichal Simek {
81758de97bSMichal Simek #if defined(CONFIG_NEEDS_MANUAL_RELOC)
82758de97bSMichal Simek 	struct sysreset_ops *ops = sysreset_get_ops(dev);
83758de97bSMichal Simek 	static int reloc_done;
84758de97bSMichal Simek 
85758de97bSMichal Simek 	if (!reloc_done) {
86758de97bSMichal Simek 		if (ops->request)
87758de97bSMichal Simek 			ops->request += gd->reloc_off;
88758de97bSMichal Simek 		reloc_done++;
89758de97bSMichal Simek 	}
90758de97bSMichal Simek #endif
91758de97bSMichal Simek 	return 0;
92758de97bSMichal Simek }
93758de97bSMichal Simek 
94b25732c2SMax Filippov UCLASS_DRIVER(sysreset) = {
95b25732c2SMax Filippov 	.id		= UCLASS_SYSRESET,
96b25732c2SMax Filippov 	.name		= "sysreset",
97758de97bSMichal Simek 	.post_bind	= sysreset_post_bind,
98b25732c2SMax Filippov };
99