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 | // 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 <command.h> #include <cpu_func.h> #include <hang.h> #include <log.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/delay.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(struct cmd_tbl *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(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 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, }; |