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