1*4882a593Smuzhiyun /*
2*4882a593Smuzhiyun * Copyright (C) 2015 Google, Inc
3*4882a593Smuzhiyun * Written by Simon Glass <sjg@chromium.org>
4*4882a593Smuzhiyun *
5*4882a593Smuzhiyun * SPDX-License-Identifier: GPL-2.0+
6*4882a593Smuzhiyun */
7*4882a593Smuzhiyun
8*4882a593Smuzhiyun #include <common.h>
9*4882a593Smuzhiyun #include <sysreset.h>
10*4882a593Smuzhiyun #include <dm.h>
11*4882a593Smuzhiyun #include <errno.h>
12*4882a593Smuzhiyun #include <regmap.h>
13*4882a593Smuzhiyun #include <dm/device-internal.h>
14*4882a593Smuzhiyun #include <dm/lists.h>
15*4882a593Smuzhiyun #include <dm/root.h>
16*4882a593Smuzhiyun #include <linux/err.h>
17*4882a593Smuzhiyun
sysreset_request(struct udevice * dev,enum sysreset_t type)18*4882a593Smuzhiyun int sysreset_request(struct udevice *dev, enum sysreset_t type)
19*4882a593Smuzhiyun {
20*4882a593Smuzhiyun struct sysreset_ops *ops = sysreset_get_ops(dev);
21*4882a593Smuzhiyun
22*4882a593Smuzhiyun if (!ops->request)
23*4882a593Smuzhiyun return -ENOSYS;
24*4882a593Smuzhiyun
25*4882a593Smuzhiyun return ops->request(dev, type);
26*4882a593Smuzhiyun }
27*4882a593Smuzhiyun
sysreset_walk(enum sysreset_t type)28*4882a593Smuzhiyun int sysreset_walk(enum sysreset_t type)
29*4882a593Smuzhiyun {
30*4882a593Smuzhiyun struct udevice *dev;
31*4882a593Smuzhiyun int ret = -ENOSYS;
32*4882a593Smuzhiyun
33*4882a593Smuzhiyun while (ret != -EINPROGRESS && type < SYSRESET_COUNT) {
34*4882a593Smuzhiyun for (uclass_first_device(UCLASS_SYSRESET, &dev);
35*4882a593Smuzhiyun dev;
36*4882a593Smuzhiyun uclass_next_device(&dev)) {
37*4882a593Smuzhiyun ret = sysreset_request(dev, type);
38*4882a593Smuzhiyun if (ret == -EINPROGRESS)
39*4882a593Smuzhiyun break;
40*4882a593Smuzhiyun }
41*4882a593Smuzhiyun type++;
42*4882a593Smuzhiyun }
43*4882a593Smuzhiyun
44*4882a593Smuzhiyun return ret;
45*4882a593Smuzhiyun }
46*4882a593Smuzhiyun
sysreset_walk_reboot_mode(const char * mode)47*4882a593Smuzhiyun static void sysreset_walk_reboot_mode(const char *mode)
48*4882a593Smuzhiyun {
49*4882a593Smuzhiyun struct sysreset_ops *ops;
50*4882a593Smuzhiyun struct udevice *dev;
51*4882a593Smuzhiyun
52*4882a593Smuzhiyun if (!mode)
53*4882a593Smuzhiyun return;
54*4882a593Smuzhiyun
55*4882a593Smuzhiyun for (uclass_first_device(UCLASS_SYSRESET, &dev);
56*4882a593Smuzhiyun dev;
57*4882a593Smuzhiyun uclass_next_device(&dev)) {
58*4882a593Smuzhiyun ops = sysreset_get_ops(dev);
59*4882a593Smuzhiyun if (ops && ops->request_by_mode) {
60*4882a593Smuzhiyun ops->request_by_mode(dev, mode);
61*4882a593Smuzhiyun break;
62*4882a593Smuzhiyun }
63*4882a593Smuzhiyun }
64*4882a593Smuzhiyun }
65*4882a593Smuzhiyun
sysreset_walk_halt(enum sysreset_t type)66*4882a593Smuzhiyun void sysreset_walk_halt(enum sysreset_t type)
67*4882a593Smuzhiyun {
68*4882a593Smuzhiyun int ret;
69*4882a593Smuzhiyun
70*4882a593Smuzhiyun ret = sysreset_walk(type);
71*4882a593Smuzhiyun
72*4882a593Smuzhiyun /* Wait for the reset to take effect */
73*4882a593Smuzhiyun if (ret == -EINPROGRESS)
74*4882a593Smuzhiyun mdelay(100);
75*4882a593Smuzhiyun
76*4882a593Smuzhiyun /* Still no reset? Give up */
77*4882a593Smuzhiyun debug("System reset not supported on this platform\n");
78*4882a593Smuzhiyun hang();
79*4882a593Smuzhiyun }
80*4882a593Smuzhiyun
81*4882a593Smuzhiyun /**
82*4882a593Smuzhiyun * reset_cpu() - calls sysreset_walk(SYSRESET_WARM)
83*4882a593Smuzhiyun */
reset_cpu(ulong addr)84*4882a593Smuzhiyun void reset_cpu(ulong addr)
85*4882a593Smuzhiyun {
86*4882a593Smuzhiyun sysreset_walk_halt(SYSRESET_WARM);
87*4882a593Smuzhiyun }
88*4882a593Smuzhiyun
reboot(const char * mode)89*4882a593Smuzhiyun void reboot(const char *mode)
90*4882a593Smuzhiyun {
91*4882a593Smuzhiyun sysreset_walk_reboot_mode(mode);
92*4882a593Smuzhiyun flushc();
93*4882a593Smuzhiyun sysreset_walk_halt(SYSRESET_COLD);
94*4882a593Smuzhiyun }
95*4882a593Smuzhiyun
do_reset(cmd_tbl_t * cmdtp,int flag,int argc,char * const argv[])96*4882a593Smuzhiyun int do_reset(cmd_tbl_t *cmdtp, int flag, int argc, char * const argv[])
97*4882a593Smuzhiyun {
98*4882a593Smuzhiyun if (argc > 1)
99*4882a593Smuzhiyun reboot(argv[1]);
100*4882a593Smuzhiyun else
101*4882a593Smuzhiyun reboot(NULL);
102*4882a593Smuzhiyun
103*4882a593Smuzhiyun return 0;
104*4882a593Smuzhiyun }
105*4882a593Smuzhiyun
106*4882a593Smuzhiyun UCLASS_DRIVER(sysreset) = {
107*4882a593Smuzhiyun .id = UCLASS_SYSRESET,
108*4882a593Smuzhiyun .name = "sysreset",
109*4882a593Smuzhiyun };
110