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 33*bbef4bcaSJoseph Chen /* 34*bbef4bcaSJoseph Chen * Use psci sysreset as primary for rockchip platforms, 35*bbef4bcaSJoseph Chen * "rockchip_reset" is applied if PSCI is disabled. 36*bbef4bcaSJoseph Chen */ 37*bbef4bcaSJoseph Chen #if !defined(CONFIG_TPL_BUILD) && \ 38*bbef4bcaSJoseph Chen defined(CONFIG_ARCH_ROCKCHIP) && defined(CONFIG_SYSRESET_PSCI) 39*bbef4bcaSJoseph Chen ret = uclass_get_device_by_driver(UCLASS_SYSRESET, 40*bbef4bcaSJoseph Chen DM_GET_DRIVER(psci_sysreset), &dev); 41*bbef4bcaSJoseph Chen if (!ret) 42*bbef4bcaSJoseph Chen sysreset_request(dev, type); 43*bbef4bcaSJoseph Chen else 44*bbef4bcaSJoseph Chen printf("WARN: PSCI sysreset is disabled\n"); 45*bbef4bcaSJoseph Chen #endif 46*bbef4bcaSJoseph Chen 47b25732c2SMax Filippov while (ret != -EINPROGRESS && type < SYSRESET_COUNT) { 48b25732c2SMax Filippov for (uclass_first_device(UCLASS_SYSRESET, &dev); 49b25732c2SMax Filippov dev; 50b25732c2SMax Filippov uclass_next_device(&dev)) { 51b25732c2SMax Filippov ret = sysreset_request(dev, type); 52b25732c2SMax Filippov if (ret == -EINPROGRESS) 53b25732c2SMax Filippov break; 54b25732c2SMax Filippov } 55b25732c2SMax Filippov type++; 56b25732c2SMax Filippov } 57b25732c2SMax Filippov 58b25732c2SMax Filippov return ret; 59b25732c2SMax Filippov } 60b25732c2SMax Filippov 61b25732c2SMax Filippov void sysreset_walk_halt(enum sysreset_t type) 62b25732c2SMax Filippov { 63b25732c2SMax Filippov int ret; 64b25732c2SMax Filippov 65b25732c2SMax Filippov ret = sysreset_walk(type); 66b25732c2SMax Filippov 67b25732c2SMax Filippov /* Wait for the reset to take effect */ 68b25732c2SMax Filippov if (ret == -EINPROGRESS) 69b25732c2SMax Filippov mdelay(100); 70b25732c2SMax Filippov 71b25732c2SMax Filippov /* Still no reset? Give up */ 72b25732c2SMax Filippov debug("System reset not supported on this platform\n"); 73b25732c2SMax Filippov hang(); 74b25732c2SMax Filippov } 75b25732c2SMax Filippov 76b25732c2SMax Filippov /** 77b25732c2SMax Filippov * reset_cpu() - calls sysreset_walk(SYSRESET_WARM) 78b25732c2SMax Filippov */ 79b25732c2SMax Filippov void reset_cpu(ulong addr) 80b25732c2SMax Filippov { 81b25732c2SMax Filippov sysreset_walk_halt(SYSRESET_WARM); 82b25732c2SMax Filippov } 83b25732c2SMax Filippov 84b25732c2SMax Filippov 85b25732c2SMax Filippov int do_reset(cmd_tbl_t *cmdtp, int flag, int argc, char * const argv[]) 86b25732c2SMax Filippov { 8713e1d840SPhilipp Tomsich sysreset_walk_halt(SYSRESET_COLD); 88b25732c2SMax Filippov 89b25732c2SMax Filippov return 0; 90b25732c2SMax Filippov } 91b25732c2SMax Filippov 92b25732c2SMax Filippov UCLASS_DRIVER(sysreset) = { 93b25732c2SMax Filippov .id = UCLASS_SYSRESET, 94b25732c2SMax Filippov .name = "sysreset", 95b25732c2SMax Filippov }; 96