drivers/sysreset/sysreset-uclass.c

   1 // SPDX-License-Identifier: GPL-2.0+
   2 /*
   3  * Copyright (C) 2015 Google, Inc
   4  * Written by Simon Glass <sjg@chromium.org>
   5  */
   6
   7 #define LOG_CATEGORY UCLASS_SYSRESET
   8
   9 #include <common.h>
  10 #include <command.h>
  11 #include <cpu_func.h>
  12 #include <dm.h>
  13 #include <errno.h>
  14 #include <hang.h>
  15 #include <log.h>
  16 #include <regmap.h>
  17 #include <spl.h>
  18 #include <sysreset.h>
  19 #include <dm/device-internal.h>
  20 #include <dm/lists.h>
  21 #include <dm/root.h>
  22 #include <linux/delay.h>
  23 #include <linux/err.h>
  24 #include <asm/global_data.h>
  25
  26 int sysreset_request(struct udevice *dev, enum sysreset_t type)
  27 {
  28         struct sysreset_ops *ops = sysreset_get_ops(dev);
  29
  30         if (!ops->request)
  31                 return -ENOSYS;
  32
  33         return ops->request(dev, type);
  34 }
  35
  36 int sysreset_get_status(struct udevice *dev, char *buf, int size)
  37 {
  38         struct sysreset_ops *ops = sysreset_get_ops(dev);
  39
  40         if (!ops->get_status)
  41                 return -ENOSYS;
  42
  43         return ops->get_status(dev, buf, size);
  44 }
  45
  46 int sysreset_get_last(struct udevice *dev)
  47 {
  48         struct sysreset_ops *ops = sysreset_get_ops(dev);
  49
  50         if (!ops->get_last)
  51                 return -ENOSYS;
  52
  53         return ops->get_last(dev);
  54 }
  55
  56 int sysreset_walk(enum sysreset_t type)
  57 {
  58         struct udevice *dev;
  59         int ret = -ENOSYS;
  60
  61         while (ret != -EINPROGRESS && type < SYSRESET_COUNT) {
  62                 for (uclass_first_device(UCLASS_SYSRESET, &dev);
  63                      dev;
  64                      uclass_next_device(&dev)) {
  65                         ret = sysreset_request(dev, type);
  66                         if (ret == -EINPROGRESS)
  67                                 break;
  68                 }
  69                 type++;
  70         }
  71
  72         return ret;
  73 }
  74
  75 int sysreset_get_last_walk(void)
  76 {
  77         struct udevice *dev;
  78         int value = -ENOENT;
  79
  80         for (uclass_first_device(UCLASS_SYSRESET, &dev);
  81              dev;
  82              uclass_next_device(&dev)) {
  83                 int ret;
  84
  85                 ret = sysreset_get_last(dev);
  86                 if (ret >= 0) {
  87                         value = ret;
  88                         break;
  89                 }
  90         }
  91
  92         return value;
  93 }
  94
  95 void sysreset_walk_halt(enum sysreset_t type)
  96 {
  97         int ret;
  98
  99         ret = sysreset_walk(type);
 100
 101         /* Wait for the reset to take effect */
 102         if (ret == -EINPROGRESS)
 103                 mdelay(100);
 104
 105         /* Still no reset? Give up */
 106         if (spl_phase() <= PHASE_SPL)
 107                 log_err("no sysreset\n");
 108         else
 109                 log_err("System reset not supported on this platform\n");
 110         hang();
 111 }
 112
 113 /**
 114  * reset_cpu() - calls sysreset_walk(SYSRESET_WARM)
 115  */
 116 void reset_cpu(void)
 117 {
 118         sysreset_walk_halt(SYSRESET_WARM);
 119 }
 120
 121
 122 #if IS_ENABLED(CONFIG_SYSRESET_CMD_RESET)
 123 int do_reset(struct cmd_tbl *cmdtp, int flag, int argc, char *const argv[])
 124 {
 125         enum sysreset_t reset_type = SYSRESET_COLD;
 126
 127         if (argc > 2)
 128                 return CMD_RET_USAGE;
 129
 130         if (argc == 2 && argv[1][0] == '-' && argv[1][1] == 'w') {
 131                 reset_type = SYSRESET_WARM;
 132         }
 133
 134         printf("resetting ...\n");
 135         mdelay(100);
 136
 137         sysreset_walk_halt(reset_type);
 138
 139         return 0;
 140 }
 141 #endif
 142
 143 #if IS_ENABLED(CONFIG_SYSRESET_CMD_POWEROFF)
 144 int do_poweroff(struct cmd_tbl *cmdtp, int flag, int argc, char *const argv[])
 145 {
 146         int ret;
 147
 148         puts("poweroff ...\n");
 149         mdelay(100);
 150
 151         ret = sysreset_walk(SYSRESET_POWER_OFF);
 152
 153         if (ret == -EINPROGRESS)
 154                 mdelay(1000);
 155
 156         /*NOTREACHED when power off*/
 157         return CMD_RET_FAILURE;
 158 }
 159 #endif
 160
 161 static int sysreset_post_bind(struct udevice *dev)
 162 {
 163 #if defined(CONFIG_NEEDS_MANUAL_RELOC)
 164         struct sysreset_ops *ops = sysreset_get_ops(dev);
 165         static int reloc_done;
 166
 167         if (!reloc_done) {
 168                 if (ops->request)
 169                         ops->request += gd->reloc_off;
 170                 reloc_done++;
 171         }
 172 #endif
 173         return 0;
 174 }
 175
 176 UCLASS_DRIVER(sysreset) = {
 177         .id             = UCLASS_SYSRESET,
 178         .name           = "sysreset",
 179         .post_bind      = sysreset_post_bind,
 180 };