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