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 
7eb517315SSimon Glass #define LOG_CATEGORY UCLASS_SYSRESET
8eb517315SSimon Glass 
9b25732c2SMax Filippov #include <common.h>
10b25732c2SMax Filippov #include <sysreset.h>
11b25732c2SMax Filippov #include <dm.h>
12b25732c2SMax Filippov #include <errno.h>
13b25732c2SMax Filippov #include <regmap.h>
14b25732c2SMax Filippov #include <dm/device-internal.h>
15b25732c2SMax Filippov #include <dm/lists.h>
16b25732c2SMax Filippov #include <dm/root.h>
17b25732c2SMax Filippov #include <linux/err.h>
18b25732c2SMax Filippov 
sysreset_request(struct udevice * dev,enum sysreset_t type)19b25732c2SMax Filippov int sysreset_request(struct udevice *dev, enum sysreset_t type)
20b25732c2SMax Filippov {
21b25732c2SMax Filippov 	struct sysreset_ops *ops = sysreset_get_ops(dev);
22b25732c2SMax Filippov 
23b25732c2SMax Filippov 	if (!ops->request)
24b25732c2SMax Filippov 		return -ENOSYS;
25b25732c2SMax Filippov 
26b25732c2SMax Filippov 	return ops->request(dev, type);
27b25732c2SMax Filippov }
28b25732c2SMax Filippov 
sysreset_get_status(struct udevice * dev,char * buf,int size)29245f5cdaSMario Six int sysreset_get_status(struct udevice *dev, char *buf, int size)
30245f5cdaSMario Six {
31245f5cdaSMario Six 	struct sysreset_ops *ops = sysreset_get_ops(dev);
32245f5cdaSMario Six 
33245f5cdaSMario Six 	if (!ops->get_status)
34245f5cdaSMario Six 		return -ENOSYS;
35245f5cdaSMario Six 
36245f5cdaSMario Six 	return ops->get_status(dev, buf, size);
37245f5cdaSMario Six }
38245f5cdaSMario Six 
sysreset_get_last(struct udevice * dev)39*751fed42SSimon Glass int sysreset_get_last(struct udevice *dev)
40*751fed42SSimon Glass {
41*751fed42SSimon Glass 	struct sysreset_ops *ops = sysreset_get_ops(dev);
42*751fed42SSimon Glass 
43*751fed42SSimon Glass 	if (!ops->get_last)
44*751fed42SSimon Glass 		return -ENOSYS;
45*751fed42SSimon Glass 
46*751fed42SSimon Glass 	return ops->get_last(dev);
47*751fed42SSimon Glass }
48*751fed42SSimon Glass 
sysreset_walk(enum sysreset_t type)49b25732c2SMax Filippov int sysreset_walk(enum sysreset_t type)
50b25732c2SMax Filippov {
51b25732c2SMax Filippov 	struct udevice *dev;
52b25732c2SMax Filippov 	int ret = -ENOSYS;
53b25732c2SMax Filippov 
54b25732c2SMax Filippov 	while (ret != -EINPROGRESS && type < SYSRESET_COUNT) {
55b25732c2SMax Filippov 		for (uclass_first_device(UCLASS_SYSRESET, &dev);
56b25732c2SMax Filippov 		     dev;
57b25732c2SMax Filippov 		     uclass_next_device(&dev)) {
58b25732c2SMax Filippov 			ret = sysreset_request(dev, type);
59b25732c2SMax Filippov 			if (ret == -EINPROGRESS)
60b25732c2SMax Filippov 				break;
61b25732c2SMax Filippov 		}
62b25732c2SMax Filippov 		type++;
63b25732c2SMax Filippov 	}
64b25732c2SMax Filippov 
65b25732c2SMax Filippov 	return ret;
66b25732c2SMax Filippov }
67b25732c2SMax Filippov 
sysreset_get_last_walk(void)68*751fed42SSimon Glass int sysreset_get_last_walk(void)
69*751fed42SSimon Glass {
70*751fed42SSimon Glass 	struct udevice *dev;
71*751fed42SSimon Glass 	int value = -ENOENT;
72*751fed42SSimon Glass 
73*751fed42SSimon Glass 	for (uclass_first_device(UCLASS_SYSRESET, &dev);
74*751fed42SSimon Glass 	     dev;
75*751fed42SSimon Glass 	     uclass_next_device(&dev)) {
76*751fed42SSimon Glass 		int ret;
77*751fed42SSimon Glass 
78*751fed42SSimon Glass 		ret = sysreset_get_last(dev);
79*751fed42SSimon Glass 		if (ret >= 0) {
80*751fed42SSimon Glass 			value = ret;
81*751fed42SSimon Glass 			break;
82*751fed42SSimon Glass 		}
83*751fed42SSimon Glass 	}
84*751fed42SSimon Glass 
85*751fed42SSimon Glass 	return value;
86*751fed42SSimon Glass }
87*751fed42SSimon Glass 
sysreset_walk_halt(enum sysreset_t type)88b25732c2SMax Filippov void sysreset_walk_halt(enum sysreset_t type)
89b25732c2SMax Filippov {
90b25732c2SMax Filippov 	int ret;
91b25732c2SMax Filippov 
92b25732c2SMax Filippov 	ret = sysreset_walk(type);
93b25732c2SMax Filippov 
94b25732c2SMax Filippov 	/* Wait for the reset to take effect */
95b25732c2SMax Filippov 	if (ret == -EINPROGRESS)
96b25732c2SMax Filippov 		mdelay(100);
97b25732c2SMax Filippov 
98b25732c2SMax Filippov 	/* Still no reset? Give up */
99eb517315SSimon Glass 	log_err("System reset not supported on this platform\n");
100b25732c2SMax Filippov 	hang();
101b25732c2SMax Filippov }
102b25732c2SMax Filippov 
103b25732c2SMax Filippov /**
104b25732c2SMax Filippov  * reset_cpu() - calls sysreset_walk(SYSRESET_WARM)
105b25732c2SMax Filippov  */
reset_cpu(ulong addr)106b25732c2SMax Filippov void reset_cpu(ulong addr)
107b25732c2SMax Filippov {
108b25732c2SMax Filippov 	sysreset_walk_halt(SYSRESET_WARM);
109b25732c2SMax Filippov }
110b25732c2SMax Filippov 
111b25732c2SMax Filippov 
do_reset(cmd_tbl_t * cmdtp,int flag,int argc,char * const argv[])112b25732c2SMax Filippov int do_reset(cmd_tbl_t *cmdtp, int flag, int argc, char * const argv[])
113b25732c2SMax Filippov {
114406be398SBin Meng 	printf("resetting ...\n");
115406be398SBin Meng 
116b53f6992SPhilipp Tomsich 	sysreset_walk_halt(SYSRESET_COLD);
117b25732c2SMax Filippov 
118b25732c2SMax Filippov 	return 0;
119b25732c2SMax Filippov }
120b25732c2SMax Filippov 
sysreset_post_bind(struct udevice * dev)121758de97bSMichal Simek static int sysreset_post_bind(struct udevice *dev)
122758de97bSMichal Simek {
123758de97bSMichal Simek #if defined(CONFIG_NEEDS_MANUAL_RELOC)
124758de97bSMichal Simek 	struct sysreset_ops *ops = sysreset_get_ops(dev);
125758de97bSMichal Simek 	static int reloc_done;
126758de97bSMichal Simek 
127758de97bSMichal Simek 	if (!reloc_done) {
128758de97bSMichal Simek 		if (ops->request)
129758de97bSMichal Simek 			ops->request += gd->reloc_off;
130758de97bSMichal Simek 		reloc_done++;
131758de97bSMichal Simek 	}
132758de97bSMichal Simek #endif
133758de97bSMichal Simek 	return 0;
134758de97bSMichal Simek }
135758de97bSMichal Simek 
136b25732c2SMax Filippov UCLASS_DRIVER(sysreset) = {
137b25732c2SMax Filippov 	.id		= UCLASS_SYSRESET,
138b25732c2SMax Filippov 	.name		= "sysreset",
139758de97bSMichal Simek 	.post_bind	= sysreset_post_bind,
140b25732c2SMax Filippov };
141