183d290c5STom Rini // SPDX-License-Identifier: GPL-2.0+ 2b25732c2SMax Filippov /* 3b25732c2SMax Filippov * Copyright (C) 2015 Google, Inc 4b25732c2SMax Filippov * Written by Simon Glass <sjg@chromium.org> 5b25732c2SMax Filippov */ 6b25732c2SMax Filippov 7b25732c2SMax Filippov #include <common.h> 8b25732c2SMax Filippov #include <sysreset.h> 9b25732c2SMax Filippov #include <dm.h> 10b25732c2SMax Filippov #include <errno.h> 11b25732c2SMax Filippov #include <regmap.h> 12b25732c2SMax Filippov #include <dm/device-internal.h> 13b25732c2SMax Filippov #include <dm/lists.h> 14b25732c2SMax Filippov #include <dm/root.h> 15b25732c2SMax Filippov #include <linux/err.h> 16b25732c2SMax Filippov 17b25732c2SMax Filippov int sysreset_request(struct udevice *dev, enum sysreset_t type) 18b25732c2SMax Filippov { 19b25732c2SMax Filippov struct sysreset_ops *ops = sysreset_get_ops(dev); 20b25732c2SMax Filippov 21b25732c2SMax Filippov if (!ops->request) 22b25732c2SMax Filippov return -ENOSYS; 23b25732c2SMax Filippov 24b25732c2SMax Filippov return ops->request(dev, type); 25b25732c2SMax Filippov } 26b25732c2SMax Filippov 27b25732c2SMax Filippov int sysreset_walk(enum sysreset_t type) 28b25732c2SMax Filippov { 29b25732c2SMax Filippov struct udevice *dev; 30b25732c2SMax Filippov int ret = -ENOSYS; 31b25732c2SMax Filippov 32b25732c2SMax Filippov while (ret != -EINPROGRESS && type < SYSRESET_COUNT) { 33b25732c2SMax Filippov for (uclass_first_device(UCLASS_SYSRESET, &dev); 34b25732c2SMax Filippov dev; 35b25732c2SMax Filippov uclass_next_device(&dev)) { 36b25732c2SMax Filippov ret = sysreset_request(dev, type); 37b25732c2SMax Filippov if (ret == -EINPROGRESS) 38b25732c2SMax Filippov break; 39b25732c2SMax Filippov } 40b25732c2SMax Filippov type++; 41b25732c2SMax Filippov } 42b25732c2SMax Filippov 43b25732c2SMax Filippov return ret; 44b25732c2SMax Filippov } 45b25732c2SMax Filippov 46b25732c2SMax Filippov void sysreset_walk_halt(enum sysreset_t type) 47b25732c2SMax Filippov { 48b25732c2SMax Filippov int ret; 49b25732c2SMax Filippov 50b25732c2SMax Filippov ret = sysreset_walk(type); 51b25732c2SMax Filippov 52b25732c2SMax Filippov /* Wait for the reset to take effect */ 53b25732c2SMax Filippov if (ret == -EINPROGRESS) 54b25732c2SMax Filippov mdelay(100); 55b25732c2SMax Filippov 56b25732c2SMax Filippov /* Still no reset? Give up */ 57b25732c2SMax Filippov debug("System reset not supported on this platform\n"); 58b25732c2SMax Filippov hang(); 59b25732c2SMax Filippov } 60b25732c2SMax Filippov 61b25732c2SMax Filippov /** 62b25732c2SMax Filippov * reset_cpu() - calls sysreset_walk(SYSRESET_WARM) 63b25732c2SMax Filippov */ 64b25732c2SMax Filippov void reset_cpu(ulong addr) 65b25732c2SMax Filippov { 66b25732c2SMax Filippov sysreset_walk_halt(SYSRESET_WARM); 67b25732c2SMax Filippov } 68b25732c2SMax Filippov 69b25732c2SMax Filippov 70b25732c2SMax Filippov int do_reset(cmd_tbl_t *cmdtp, int flag, int argc, char * const argv[]) 71b25732c2SMax Filippov { 72*406be398SBin Meng printf("resetting ...\n"); 73*406be398SBin Meng 74b53f6992SPhilipp Tomsich sysreset_walk_halt(SYSRESET_COLD); 75b25732c2SMax Filippov 76b25732c2SMax Filippov return 0; 77b25732c2SMax Filippov } 78b25732c2SMax Filippov 79758de97bSMichal Simek static int sysreset_post_bind(struct udevice *dev) 80758de97bSMichal Simek { 81758de97bSMichal Simek #if defined(CONFIG_NEEDS_MANUAL_RELOC) 82758de97bSMichal Simek struct sysreset_ops *ops = sysreset_get_ops(dev); 83758de97bSMichal Simek static int reloc_done; 84758de97bSMichal Simek 85758de97bSMichal Simek if (!reloc_done) { 86758de97bSMichal Simek if (ops->request) 87758de97bSMichal Simek ops->request += gd->reloc_off; 88758de97bSMichal Simek reloc_done++; 89758de97bSMichal Simek } 90758de97bSMichal Simek #endif 91758de97bSMichal Simek return 0; 92758de97bSMichal Simek } 93758de97bSMichal Simek 94b25732c2SMax Filippov UCLASS_DRIVER(sysreset) = { 95b25732c2SMax Filippov .id = UCLASS_SYSRESET, 96b25732c2SMax Filippov .name = "sysreset", 97758de97bSMichal Simek .post_bind = sysreset_post_bind, 98b25732c2SMax Filippov }; 99