reset-mediatek.c 2.3 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106
  1. // SPDX-License-Identifier: GPL-2.0
  2. /*
  3. * Copyright (C) 2018 MediaTek Inc.
  4. *
  5. * Author: Ryder Lee <ryder.lee@mediatek.com>
  6. * Weijie Gao <weijie.gao@mediatek.com>
  7. */
  8. #include <common.h>
  9. #include <dm.h>
  10. #include <log.h>
  11. #include <malloc.h>
  12. #include <dm/lists.h>
  13. #include <regmap.h>
  14. #include <reset-uclass.h>
  15. #include <syscon.h>
  16. #include <linux/bitops.h>
  17. #include <linux/err.h>
  18. struct mediatek_reset_priv {
  19. struct regmap *regmap;
  20. u32 regofs;
  21. u32 nr_resets;
  22. };
  23. static int mediatek_reset_request(struct reset_ctl *reset_ctl)
  24. {
  25. return 0;
  26. }
  27. static int mediatek_reset_free(struct reset_ctl *reset_ctl)
  28. {
  29. return 0;
  30. }
  31. static int mediatek_reset_assert(struct reset_ctl *reset_ctl)
  32. {
  33. struct mediatek_reset_priv *priv = dev_get_priv(reset_ctl->dev);
  34. int id = reset_ctl->id;
  35. if (id >= priv->nr_resets)
  36. return -EINVAL;
  37. return regmap_update_bits(priv->regmap,
  38. priv->regofs + ((id / 32) << 2), BIT(id % 32), BIT(id % 32));
  39. }
  40. static int mediatek_reset_deassert(struct reset_ctl *reset_ctl)
  41. {
  42. struct mediatek_reset_priv *priv = dev_get_priv(reset_ctl->dev);
  43. int id = reset_ctl->id;
  44. if (id >= priv->nr_resets)
  45. return -EINVAL;
  46. return regmap_update_bits(priv->regmap,
  47. priv->regofs + ((id / 32) << 2), BIT(id % 32), 0);
  48. }
  49. struct reset_ops mediatek_reset_ops = {
  50. .request = mediatek_reset_request,
  51. .rfree = mediatek_reset_free,
  52. .rst_assert = mediatek_reset_assert,
  53. .rst_deassert = mediatek_reset_deassert,
  54. };
  55. static int mediatek_reset_probe(struct udevice *dev)
  56. {
  57. struct mediatek_reset_priv *priv = dev_get_priv(dev);
  58. if (!priv->regofs && !priv->nr_resets)
  59. return -EINVAL;
  60. priv->regmap = syscon_node_to_regmap(dev_ofnode(dev));
  61. if (IS_ERR(priv->regmap))
  62. return PTR_ERR(priv->regmap);
  63. return 0;
  64. }
  65. int mediatek_reset_bind(struct udevice *pdev, u32 regofs, u32 num_regs)
  66. {
  67. struct udevice *rst_dev;
  68. struct mediatek_reset_priv *priv;
  69. int ret;
  70. ret = device_bind_driver_to_node(pdev, "mediatek_reset", "reset",
  71. dev_ofnode(pdev), &rst_dev);
  72. if (ret)
  73. return ret;
  74. priv = malloc(sizeof(struct mediatek_reset_priv));
  75. priv->regofs = regofs;
  76. priv->nr_resets = num_regs * 32;
  77. rst_dev->priv = priv;
  78. return 0;
  79. }
  80. U_BOOT_DRIVER(mediatek_reset) = {
  81. .name = "mediatek_reset",
  82. .id = UCLASS_RESET,
  83. .probe = mediatek_reset_probe,
  84. .ops = &mediatek_reset_ops,
  85. .priv_auto_alloc_size = sizeof(struct mediatek_reset_priv),
  86. };