Loading...
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25 26 27 28 29 30 31 32 33 34 35 36 37 38 39 40 41 42 43 44 45 46 47 48 49 50 51 52 53 54 55 56 57 58 59 60 61 62 63 64 65 66 67 68 69 70 71 72 73 74 75 76 77 78 79 80 81 82 83 84 85 86 87 88 89 90 91 92 93 94 95 96 97 98 99 100 101 102 103 104 105 106 107 108 109 110 111 112 113 114 115 116 117 118 119 120 121 122 123 124 125 126 127 128 129 130 131 132 133 134 135 136 137 138 139 140 141 142 143 144 145 146 147 148 149 150 151 152 153 154 155 156 157 158 159 160 161 162 163 164 165 166 167 168 169 170 171 172 173 174 175 176 177 178 179 180 181 182 183 184 185 186 187 188 189 190 191 192 193 194 195 196 197 198 199 | // SPDX-License-Identifier: GPL-2.0+ /* * Copyright (C) 2015 Google, Inc * Written by Simon Glass <sjg@chromium.org> */ #define LOG_CATEGORY UCLASS_SYSRESET #include <command.h> #include <cpu_func.h> #include <dm.h> #include <errno.h> #include <hang.h> #include <log.h> #include <regmap.h> #include <spl.h> #include <sysreset.h> #include <dm/device-internal.h> #include <dm/lists.h> #include <dm/root.h> #include <linux/delay.h> #include <linux/err.h> #include <asm/global_data.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); } #if IS_ENABLED(CONFIG_SYSRESET_CMD_RESET_ARGS) int sysreset_request_arg(struct udevice *dev, int argc, char * const argv[]) { struct sysreset_ops *ops = sysreset_get_ops(dev); if (!ops->request_arg) return -ENOSYS; return ops->request_arg(dev, argc, argv); } #endif /* CONFIG_SYSRESET_CMD_RESET_ARGS */ 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; } #if IS_ENABLED(CONFIG_SYSRESET_CMD_RESET_ARGS) int sysreset_walk_arg(int argc, char * const argv[]) { struct udevice *dev; int ret = -ENOSYS; while (ret != -EINPROGRESS && ret != -EPROTONOSUPPORT) { for (uclass_first_device(UCLASS_SYSRESET, &dev); dev; uclass_next_device(&dev)) { ret = sysreset_request_arg(dev, argc, argv); if (ret == -EINPROGRESS || ret == -EPROTONOSUPPORT) break; } } return ret; } #endif /* CONFIG_SYSRESET_CMD_RESET_ARGS */ 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 */ if (xpl_phase() <= PHASE_SPL) log_err("no sysreset\n"); else log_err("System reset not supported on this platform\n"); hang(); } /** * reset_cpu() - calls sysreset_walk(SYSRESET_WARM) */ void reset_cpu(void) { sysreset_walk_halt(SYSRESET_WARM); } #if IS_ENABLED(CONFIG_SYSRESET_CMD_RESET) int do_reset(struct cmd_tbl *cmdtp, int flag, int argc, char *const argv[]) { enum sysreset_t reset_type = SYSRESET_COLD; if (argc > 2) return CMD_RET_USAGE; if (argc == 2 && argv[1][0] == '-' && argv[1][1] == 'w') { reset_type = SYSRESET_WARM; } printf("resetting ...\n"); mdelay(100); #if IS_ENABLED(CONFIG_SYSRESET_CMD_RESET_ARGS) if (argc > 1 && sysreset_walk_arg(argc, argv) == -EINPROGRESS) return 0; #endif sysreset_walk_halt(reset_type); return 0; } #endif #if IS_ENABLED(CONFIG_SYSRESET_CMD_POWEROFF) int do_poweroff(struct cmd_tbl *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 UCLASS_DRIVER(sysreset) = { .id = UCLASS_SYSRESET, .name = "sysreset", }; |