sandbox-scmi_devices.c 3.4 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141
  1. // SPDX-License-Identifier: GPL-2.0
  2. /*
  3. * Copyright (C) 2020-2021, Linaro Limited
  4. */
  5. #define LOG_CATEGORY UCLASS_MISC
  6. #include <common.h>
  7. #include <clk.h>
  8. #include <dm.h>
  9. #include <log.h>
  10. #include <malloc.h>
  11. #include <reset.h>
  12. #include <asm/io.h>
  13. #include <asm/scmi_test.h>
  14. #include <dm/device_compat.h>
  15. #include <power/regulator.h>
  16. /*
  17. * Simulate to some extent a SCMI exchange.
  18. * This drivers gets SCMI resources and offers API function to the
  19. * SCMI test sequence manipulate the resources, currently clock
  20. * and reset controllers.
  21. */
  22. #define SCMI_TEST_DEVICES_CLK_COUNT 3
  23. #define SCMI_TEST_DEVICES_RD_COUNT 1
  24. #define SCMI_TEST_DEVICES_VOLTD_COUNT 2
  25. /*
  26. * struct sandbox_scmi_device_priv - Storage for device handles used by test
  27. * @clk: Array of clock instances used by tests
  28. * @reset_clt: Array of the reset controller instances used by tests
  29. * @regulators: Array of regulator device references used by the tests
  30. * @devices: Resources exposed by sandbox_scmi_devices_ctx()
  31. */
  32. struct sandbox_scmi_device_priv {
  33. struct clk clk[SCMI_TEST_DEVICES_CLK_COUNT];
  34. struct reset_ctl reset_ctl[SCMI_TEST_DEVICES_RD_COUNT];
  35. struct udevice *regulators[SCMI_TEST_DEVICES_VOLTD_COUNT];
  36. struct sandbox_scmi_devices devices;
  37. };
  38. struct sandbox_scmi_devices *sandbox_scmi_devices_ctx(struct udevice *dev)
  39. {
  40. struct sandbox_scmi_device_priv *priv = dev_get_priv(dev);
  41. if (priv)
  42. return &priv->devices;
  43. return NULL;
  44. }
  45. static int sandbox_scmi_devices_remove(struct udevice *dev)
  46. {
  47. struct sandbox_scmi_devices *devices = sandbox_scmi_devices_ctx(dev);
  48. int ret = 0;
  49. size_t n;
  50. if (!devices)
  51. return 0;
  52. for (n = 0; n < SCMI_TEST_DEVICES_RD_COUNT; n++) {
  53. int ret2 = reset_free(devices->reset + n);
  54. if (ret2 && !ret)
  55. ret = ret2;
  56. }
  57. return ret;
  58. }
  59. static int sandbox_scmi_devices_probe(struct udevice *dev)
  60. {
  61. struct sandbox_scmi_device_priv *priv = dev_get_priv(dev);
  62. int ret;
  63. size_t n;
  64. priv->devices = (struct sandbox_scmi_devices){
  65. .clk = priv->clk,
  66. .clk_count = SCMI_TEST_DEVICES_CLK_COUNT,
  67. .reset = priv->reset_ctl,
  68. .reset_count = SCMI_TEST_DEVICES_RD_COUNT,
  69. .regul = priv->regulators,
  70. .regul_count = SCMI_TEST_DEVICES_VOLTD_COUNT,
  71. };
  72. for (n = 0; n < SCMI_TEST_DEVICES_CLK_COUNT; n++) {
  73. ret = clk_get_by_index(dev, n, priv->devices.clk + n);
  74. if (ret) {
  75. dev_err(dev, "%s: Failed on clk %zu\n", __func__, n);
  76. return ret;
  77. }
  78. }
  79. for (n = 0; n < SCMI_TEST_DEVICES_RD_COUNT; n++) {
  80. ret = reset_get_by_index(dev, n, priv->devices.reset + n);
  81. if (ret) {
  82. dev_err(dev, "%s: Failed on reset %zu\n", __func__, n);
  83. goto err_reset;
  84. }
  85. }
  86. for (n = 0; n < SCMI_TEST_DEVICES_VOLTD_COUNT; n++) {
  87. char name[32];
  88. ret = snprintf(name, sizeof(name), "regul%zu-supply", n);
  89. assert(ret >= 0 && ret < sizeof(name));
  90. ret = device_get_supply_regulator(dev, name,
  91. priv->devices.regul + n);
  92. if (ret) {
  93. dev_err(dev, "%s: Failed on voltd %zu\n", __func__, n);
  94. goto err_regul;
  95. }
  96. }
  97. return 0;
  98. err_regul:
  99. n = SCMI_TEST_DEVICES_RD_COUNT;
  100. err_reset:
  101. for (; n > 0; n--)
  102. reset_free(priv->devices.reset + n - 1);
  103. return ret;
  104. }
  105. static const struct udevice_id sandbox_scmi_devices_ids[] = {
  106. { .compatible = "sandbox,scmi-devices" },
  107. { }
  108. };
  109. U_BOOT_DRIVER(sandbox_scmi_devices) = {
  110. .name = "sandbox-scmi_devices",
  111. .id = UCLASS_MISC,
  112. .of_match = sandbox_scmi_devices_ids,
  113. .priv_auto = sizeof(struct sandbox_scmi_device_priv),
  114. .remove = sandbox_scmi_devices_remove,
  115. .probe = sandbox_scmi_devices_probe,
  116. };