clk_sandbox.c 3.4 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180
  1. // SPDX-License-Identifier: GPL-2.0
  2. /*
  3. * (C) Copyright 2015 Google, Inc
  4. */
  5. #include <common.h>
  6. #include <clk-uclass.h>
  7. #include <dm.h>
  8. #include <errno.h>
  9. #include <malloc.h>
  10. #include <asm/clk.h>
  11. struct sandbox_clk_priv {
  12. bool probed;
  13. ulong rate[SANDBOX_CLK_ID_COUNT];
  14. bool enabled[SANDBOX_CLK_ID_COUNT];
  15. bool requested[SANDBOX_CLK_ID_COUNT];
  16. };
  17. static ulong sandbox_clk_get_rate(struct clk *clk)
  18. {
  19. struct sandbox_clk_priv *priv = dev_get_priv(clk->dev);
  20. if (!priv->probed)
  21. return -ENODEV;
  22. if (clk->id >= SANDBOX_CLK_ID_COUNT)
  23. return -EINVAL;
  24. return priv->rate[clk->id];
  25. }
  26. static ulong sandbox_clk_round_rate(struct clk *clk, ulong rate)
  27. {
  28. struct sandbox_clk_priv *priv = dev_get_priv(clk->dev);
  29. if (!priv->probed)
  30. return -ENODEV;
  31. if (clk->id >= SANDBOX_CLK_ID_COUNT)
  32. return -EINVAL;
  33. if (!rate)
  34. return -EINVAL;
  35. return rate;
  36. }
  37. static ulong sandbox_clk_set_rate(struct clk *clk, ulong rate)
  38. {
  39. struct sandbox_clk_priv *priv = dev_get_priv(clk->dev);
  40. ulong old_rate;
  41. if (!priv->probed)
  42. return -ENODEV;
  43. if (clk->id >= SANDBOX_CLK_ID_COUNT)
  44. return -EINVAL;
  45. if (!rate)
  46. return -EINVAL;
  47. old_rate = priv->rate[clk->id];
  48. priv->rate[clk->id] = rate;
  49. return old_rate;
  50. }
  51. static int sandbox_clk_enable(struct clk *clk)
  52. {
  53. struct sandbox_clk_priv *priv = dev_get_priv(clk->dev);
  54. if (!priv->probed)
  55. return -ENODEV;
  56. if (clk->id >= SANDBOX_CLK_ID_COUNT)
  57. return -EINVAL;
  58. priv->enabled[clk->id] = true;
  59. return 0;
  60. }
  61. static int sandbox_clk_disable(struct clk *clk)
  62. {
  63. struct sandbox_clk_priv *priv = dev_get_priv(clk->dev);
  64. if (!priv->probed)
  65. return -ENODEV;
  66. if (clk->id >= SANDBOX_CLK_ID_COUNT)
  67. return -EINVAL;
  68. priv->enabled[clk->id] = false;
  69. return 0;
  70. }
  71. static int sandbox_clk_request(struct clk *clk)
  72. {
  73. struct sandbox_clk_priv *priv = dev_get_priv(clk->dev);
  74. if (clk->id >= SANDBOX_CLK_ID_COUNT)
  75. return -EINVAL;
  76. priv->requested[clk->id] = true;
  77. return 0;
  78. }
  79. static int sandbox_clk_free(struct clk *clk)
  80. {
  81. struct sandbox_clk_priv *priv = dev_get_priv(clk->dev);
  82. if (clk->id >= SANDBOX_CLK_ID_COUNT)
  83. return -EINVAL;
  84. priv->requested[clk->id] = false;
  85. return 0;
  86. }
  87. static struct clk_ops sandbox_clk_ops = {
  88. .round_rate = sandbox_clk_round_rate,
  89. .get_rate = sandbox_clk_get_rate,
  90. .set_rate = sandbox_clk_set_rate,
  91. .enable = sandbox_clk_enable,
  92. .disable = sandbox_clk_disable,
  93. .request = sandbox_clk_request,
  94. .rfree = sandbox_clk_free,
  95. };
  96. static int sandbox_clk_probe(struct udevice *dev)
  97. {
  98. struct sandbox_clk_priv *priv = dev_get_priv(dev);
  99. priv->probed = true;
  100. return 0;
  101. }
  102. static const struct udevice_id sandbox_clk_ids[] = {
  103. { .compatible = "sandbox,clk" },
  104. { }
  105. };
  106. U_BOOT_DRIVER(sandbox_clk) = {
  107. .name = "sandbox_clk",
  108. .id = UCLASS_CLK,
  109. .of_match = sandbox_clk_ids,
  110. .ops = &sandbox_clk_ops,
  111. .probe = sandbox_clk_probe,
  112. .priv_auto = sizeof(struct sandbox_clk_priv),
  113. };
  114. ulong sandbox_clk_query_rate(struct udevice *dev, int id)
  115. {
  116. struct sandbox_clk_priv *priv = dev_get_priv(dev);
  117. if (id < 0 || id >= SANDBOX_CLK_ID_COUNT)
  118. return -EINVAL;
  119. return priv->rate[id];
  120. }
  121. int sandbox_clk_query_enable(struct udevice *dev, int id)
  122. {
  123. struct sandbox_clk_priv *priv = dev_get_priv(dev);
  124. if (id < 0 || id >= SANDBOX_CLK_ID_COUNT)
  125. return -EINVAL;
  126. return priv->enabled[id];
  127. }
  128. int sandbox_clk_query_requested(struct udevice *dev, int id)
  129. {
  130. struct sandbox_clk_priv *priv = dev_get_priv(dev);
  131. if (id < 0 || id >= SANDBOX_CLK_ID_COUNT)
  132. return -EINVAL;
  133. return priv->requested[id];
  134. }