sysreset_watchdog.c 1.7 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990
  1. // SPDX-License-Identifier: GPL-2.0+
  2. /*
  3. * Copyright (C) 2017 Álvaro Fernández Rojas <noltari@gmail.com>
  4. */
  5. #include <common.h>
  6. #include <dm.h>
  7. #include <dm/device-internal.h>
  8. #include <errno.h>
  9. #include <malloc.h>
  10. #include <sysreset.h>
  11. #include <wdt.h>
  12. struct wdt_reboot_plat {
  13. struct udevice *wdt;
  14. };
  15. static int wdt_reboot_request(struct udevice *dev, enum sysreset_t type)
  16. {
  17. struct wdt_reboot_plat *plat = dev_get_plat(dev);
  18. int ret;
  19. switch (type) {
  20. case SYSRESET_COLD:
  21. case SYSRESET_WARM:
  22. ret = wdt_expire_now(plat->wdt, 0);
  23. if (ret)
  24. return ret;
  25. break;
  26. default:
  27. return -ENOSYS;
  28. }
  29. return -EINPROGRESS;
  30. }
  31. static struct sysreset_ops wdt_reboot_ops = {
  32. .request = wdt_reboot_request,
  33. };
  34. static int wdt_reboot_of_to_plat(struct udevice *dev)
  35. {
  36. struct wdt_reboot_plat *plat = dev_get_plat(dev);
  37. int err;
  38. err = uclass_get_device_by_phandle(UCLASS_WDT, dev,
  39. "wdt", &plat->wdt);
  40. if (err) {
  41. pr_err("unable to find wdt device\n");
  42. return err;
  43. }
  44. return 0;
  45. }
  46. static const struct udevice_id wdt_reboot_ids[] = {
  47. { .compatible = "wdt-reboot" },
  48. { /* sentinel */ }
  49. };
  50. U_BOOT_DRIVER(wdt_reboot) = {
  51. .name = "wdt_reboot",
  52. .id = UCLASS_SYSRESET,
  53. .of_match = wdt_reboot_ids,
  54. .of_to_plat = wdt_reboot_of_to_plat,
  55. .plat_auto = sizeof(struct wdt_reboot_plat),
  56. .ops = &wdt_reboot_ops,
  57. };
  58. #if IS_ENABLED(CONFIG_SYSRESET_WATCHDOG_AUTO)
  59. int sysreset_register_wdt(struct udevice *dev)
  60. {
  61. struct wdt_reboot_plat *plat = malloc(sizeof(*plat));
  62. int ret;
  63. if (!plat)
  64. return -ENOMEM;
  65. plat->wdt = dev;
  66. ret = device_bind(dev, DM_DRIVER_GET(wdt_reboot),
  67. dev->name, plat, ofnode_null(), NULL);
  68. if (ret) {
  69. free(plat);
  70. return ret;
  71. }
  72. return 0;
  73. }
  74. #endif