power-domain-uclass.c 3.5 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155
  1. // SPDX-License-Identifier: GPL-2.0
  2. /*
  3. * Copyright (c) 2016, NVIDIA CORPORATION.
  4. */
  5. #include <common.h>
  6. #include <dm.h>
  7. #include <power-domain.h>
  8. #include <power-domain-uclass.h>
  9. #include <dm/device-internal.h>
  10. static inline struct power_domain_ops *power_domain_dev_ops(struct udevice *dev)
  11. {
  12. return (struct power_domain_ops *)dev->driver->ops;
  13. }
  14. static int power_domain_of_xlate_default(struct power_domain *power_domain,
  15. struct ofnode_phandle_args *args)
  16. {
  17. debug("%s(power_domain=%p)\n", __func__, power_domain);
  18. if (args->args_count != 1) {
  19. debug("Invalid args_count: %d\n", args->args_count);
  20. return -EINVAL;
  21. }
  22. power_domain->id = args->args[0];
  23. return 0;
  24. }
  25. int power_domain_get_by_index(struct udevice *dev,
  26. struct power_domain *power_domain, int index)
  27. {
  28. struct ofnode_phandle_args args;
  29. int ret;
  30. struct udevice *dev_power_domain;
  31. struct power_domain_ops *ops;
  32. debug("%s(dev=%p, power_domain=%p)\n", __func__, dev, power_domain);
  33. ret = dev_read_phandle_with_args(dev, "power-domains",
  34. "#power-domain-cells", 0, index,
  35. &args);
  36. if (ret) {
  37. debug("%s: dev_read_phandle_with_args failed: %d\n",
  38. __func__, ret);
  39. return ret;
  40. }
  41. ret = uclass_get_device_by_ofnode(UCLASS_POWER_DOMAIN, args.node,
  42. &dev_power_domain);
  43. if (ret) {
  44. debug("%s: uclass_get_device_by_ofnode failed: %d\n",
  45. __func__, ret);
  46. return ret;
  47. }
  48. ops = power_domain_dev_ops(dev_power_domain);
  49. power_domain->dev = dev_power_domain;
  50. if (ops->of_xlate)
  51. ret = ops->of_xlate(power_domain, &args);
  52. else
  53. ret = power_domain_of_xlate_default(power_domain, &args);
  54. if (ret) {
  55. debug("of_xlate() failed: %d\n", ret);
  56. return ret;
  57. }
  58. ret = ops->request(power_domain);
  59. if (ret) {
  60. debug("ops->request() failed: %d\n", ret);
  61. return ret;
  62. }
  63. return 0;
  64. }
  65. int power_domain_get(struct udevice *dev, struct power_domain *power_domain)
  66. {
  67. return power_domain_get_by_index(dev, power_domain, 0);
  68. }
  69. int power_domain_free(struct power_domain *power_domain)
  70. {
  71. struct power_domain_ops *ops = power_domain_dev_ops(power_domain->dev);
  72. debug("%s(power_domain=%p)\n", __func__, power_domain);
  73. return ops->free(power_domain);
  74. }
  75. int power_domain_on(struct power_domain *power_domain)
  76. {
  77. struct power_domain_ops *ops = power_domain_dev_ops(power_domain->dev);
  78. debug("%s(power_domain=%p)\n", __func__, power_domain);
  79. return ops->on(power_domain);
  80. }
  81. int power_domain_off(struct power_domain *power_domain)
  82. {
  83. struct power_domain_ops *ops = power_domain_dev_ops(power_domain->dev);
  84. debug("%s(power_domain=%p)\n", __func__, power_domain);
  85. return ops->off(power_domain);
  86. }
  87. #if (CONFIG_IS_ENABLED(OF_CONTROL) && !CONFIG_IS_ENABLED(OF_PLATDATA))
  88. static int dev_power_domain_ctrl(struct udevice *dev, bool on)
  89. {
  90. struct power_domain pd;
  91. int i, count, ret = 0;
  92. count = dev_count_phandle_with_args(dev, "power-domains",
  93. "#power-domain-cells");
  94. for (i = 0; i < count; i++) {
  95. ret = power_domain_get_by_index(dev, &pd, i);
  96. if (ret)
  97. return ret;
  98. if (on)
  99. ret = power_domain_on(&pd);
  100. else
  101. ret = power_domain_off(&pd);
  102. }
  103. /*
  104. * power_domain_get() bound the device, thus
  105. * we must remove it again to prevent unbinding
  106. * active devices (which would result in unbind
  107. * error).
  108. */
  109. if (count > 0 && !on)
  110. device_remove(pd.dev, DM_REMOVE_NORMAL);
  111. return ret;
  112. }
  113. int dev_power_domain_on(struct udevice *dev)
  114. {
  115. return dev_power_domain_ctrl(dev, true);
  116. }
  117. int dev_power_domain_off(struct udevice *dev)
  118. {
  119. return dev_power_domain_ctrl(dev, false);
  120. }
  121. #endif
  122. UCLASS_DRIVER(power_domain) = {
  123. .id = UCLASS_POWER_DOMAIN,
  124. .name = "power_domain",
  125. };