reset-zynqmp.c 2.3 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100
  1. // SPDX-License-Identifier: GPL-2.0
  2. /*
  3. * Copyright (C) 2021 Xilinx, Inc. - Michal Simek
  4. */
  5. #define LOG_CATEGORY UCLASS_RESET
  6. #include <common.h>
  7. #include <dm.h>
  8. #include <dm/device_compat.h>
  9. #include <reset-uclass.h>
  10. #include <zynqmp_firmware.h>
  11. #define ZYNQMP_NR_RESETS (ZYNQMP_PM_RESET_END - ZYNQMP_PM_RESET_START)
  12. #define ZYNQMP_RESET_ID ZYNQMP_PM_RESET_START
  13. struct zynqmp_reset_priv {
  14. u32 reset_id;
  15. u32 nr_reset;
  16. };
  17. static int zynqmp_pm_reset_assert(const u32 reset,
  18. const enum zynqmp_pm_reset_action assert_flag)
  19. {
  20. return xilinx_pm_request(PM_RESET_ASSERT, reset, assert_flag, 0, 0,
  21. NULL);
  22. }
  23. static int zynqmp_reset_assert(struct reset_ctl *rst)
  24. {
  25. struct zynqmp_reset_priv *priv = dev_get_priv(rst->dev);
  26. dev_dbg(rst->dev, "%s(rst=%p) (id=%lu)\n", __func__, rst, rst->id);
  27. return zynqmp_pm_reset_assert(priv->reset_id + rst->id,
  28. PM_RESET_ACTION_ASSERT);
  29. }
  30. static int zynqmp_reset_deassert(struct reset_ctl *rst)
  31. {
  32. struct zynqmp_reset_priv *priv = dev_get_priv(rst->dev);
  33. dev_dbg(rst->dev, "%s(rst=%p) (id=%lu)\n", __func__, rst, rst->id);
  34. return zynqmp_pm_reset_assert(priv->reset_id + rst->id,
  35. PM_RESET_ACTION_RELEASE);
  36. }
  37. static int zynqmp_reset_request(struct reset_ctl *rst)
  38. {
  39. struct zynqmp_reset_priv *priv = dev_get_priv(rst->dev);
  40. dev_dbg(rst->dev, "%s(rst=%p) (id=%lu) (nr_reset=%d)\n", __func__,
  41. rst, rst->id, priv->nr_reset);
  42. if (rst->id > priv->nr_reset)
  43. return -EINVAL;
  44. return 0;
  45. }
  46. static int zynqmp_reset_free(struct reset_ctl *rst)
  47. {
  48. struct zynqmp_reset_priv *priv = dev_get_priv(rst->dev);
  49. dev_dbg(rst->dev, "%s(rst=%p) (id=%lu) (nr_reset=%d)\n", __func__,
  50. rst, rst->id, priv->nr_reset);
  51. return 0;
  52. }
  53. static int zynqmp_reset_probe(struct udevice *dev)
  54. {
  55. struct zynqmp_reset_priv *priv = dev_get_priv(dev);
  56. priv->reset_id = ZYNQMP_RESET_ID;
  57. priv->nr_reset = ZYNQMP_NR_RESETS;
  58. return 0;
  59. }
  60. const struct reset_ops zynqmp_reset_ops = {
  61. .request = zynqmp_reset_request,
  62. .rfree = zynqmp_reset_free,
  63. .rst_assert = zynqmp_reset_assert,
  64. .rst_deassert = zynqmp_reset_deassert,
  65. };
  66. static const struct udevice_id zynqmp_reset_ids[] = {
  67. { .compatible = "xlnx,zynqmp-reset" },
  68. { }
  69. };
  70. U_BOOT_DRIVER(zynqmp_reset) = {
  71. .name = "zynqmp_reset",
  72. .id = UCLASS_RESET,
  73. .of_match = zynqmp_reset_ids,
  74. .ops = &zynqmp_reset_ops,
  75. .probe = zynqmp_reset_probe,
  76. .priv_auto = sizeof(struct zynqmp_reset_priv),
  77. };