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 #ifdef CONFIG_ARCH_ROCKCHIP 19 __weak void reset_misc(void) 20 { 21 } 22 #endif 23 24 int sysreset_request(struct udevice *dev, enum sysreset_t type) 25 { 26 struct sysreset_ops *ops = sysreset_get_ops(dev); 27 28 if (!ops->request) 29 return -ENOSYS; 30 31 return ops->request(dev, type); 32 } 33 34 int sysreset_walk(enum sysreset_t type) 35 { 36 struct udevice *dev; 37 int ret = -ENOSYS; 38 39 while (ret != -EINPROGRESS && type < SYSRESET_COUNT) { 40 for (uclass_first_device(UCLASS_SYSRESET, &dev); 41 dev; 42 uclass_next_device(&dev)) { 43 ret = sysreset_request(dev, type); 44 if (ret == -EINPROGRESS) 45 break; 46 } 47 type++; 48 } 49 50 return ret; 51 } 52 53 static void sysreset_walk_reboot_mode(const char *mode) 54 { 55 struct sysreset_ops *ops; 56 struct udevice *dev; 57 58 if (!mode) 59 return; 60 61 for (uclass_first_device(UCLASS_SYSRESET, &dev); 62 dev; 63 uclass_next_device(&dev)) { 64 ops = sysreset_get_ops(dev); 65 if (ops && ops->request_by_mode) { 66 ops->request_by_mode(dev, mode); 67 break; 68 } 69 } 70 } 71 72 void sysreset_walk_halt(enum sysreset_t type) 73 { 74 int ret; 75 76 ret = sysreset_walk(type); 77 78 /* Wait for the reset to take effect */ 79 if (ret == -EINPROGRESS) 80 mdelay(100); 81 82 /* Still no reset? Give up */ 83 debug("System reset not supported on this platform\n"); 84 hang(); 85 } 86 87 /** 88 * reset_cpu() - calls sysreset_walk(SYSRESET_WARM) 89 */ 90 void reset_cpu(ulong addr) 91 { 92 sysreset_walk_halt(SYSRESET_WARM); 93 } 94 95 void reboot(const char *mode) 96 { 97 sysreset_walk_reboot_mode(mode); 98 flushc(); 99 sysreset_walk_halt(SYSRESET_COLD); 100 } 101 102 int do_reset(cmd_tbl_t *cmdtp, int flag, int argc, char * const argv[]) 103 { 104 #ifdef CONFIG_ARCH_ROCKCHIP 105 reset_misc(); 106 #endif 107 108 if (argc > 1) 109 reboot(argv[1]); 110 else 111 reboot(NULL); 112 113 return 0; 114 } 115 116 UCLASS_DRIVER(sysreset) = { 117 .id = UCLASS_SYSRESET, 118 .name = "sysreset", 119 }; 120