clk_sandbox.c 4.1 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206
  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. #include <linux/clk-provider.h>
  12. static ulong sandbox_clk_get_rate(struct clk *clk)
  13. {
  14. struct sandbox_clk_priv *priv = dev_get_priv(clk->dev);
  15. if (!priv->probed)
  16. return -ENODEV;
  17. if (clk->id >= SANDBOX_CLK_ID_COUNT)
  18. return -EINVAL;
  19. return priv->rate[clk->id];
  20. }
  21. static ulong sandbox_clk_round_rate(struct clk *clk, ulong rate)
  22. {
  23. struct sandbox_clk_priv *priv = dev_get_priv(clk->dev);
  24. if (!priv->probed)
  25. return -ENODEV;
  26. if (clk->id >= SANDBOX_CLK_ID_COUNT)
  27. return -EINVAL;
  28. if (!rate)
  29. return -EINVAL;
  30. return rate;
  31. }
  32. static ulong sandbox_clk_set_rate(struct clk *clk, ulong rate)
  33. {
  34. struct sandbox_clk_priv *priv = dev_get_priv(clk->dev);
  35. ulong old_rate;
  36. if (!priv->probed)
  37. return -ENODEV;
  38. if (clk->id >= SANDBOX_CLK_ID_COUNT)
  39. return -EINVAL;
  40. if (!rate)
  41. return -EINVAL;
  42. old_rate = priv->rate[clk->id];
  43. priv->rate[clk->id] = rate;
  44. return old_rate;
  45. }
  46. static int sandbox_clk_enable(struct clk *clk)
  47. {
  48. struct sandbox_clk_priv *priv = dev_get_priv(clk->dev);
  49. if (!priv->probed)
  50. return -ENODEV;
  51. if (clk->id >= SANDBOX_CLK_ID_COUNT)
  52. return -EINVAL;
  53. priv->enabled[clk->id] = true;
  54. return 0;
  55. }
  56. static int sandbox_clk_disable(struct clk *clk)
  57. {
  58. struct sandbox_clk_priv *priv = dev_get_priv(clk->dev);
  59. if (!priv->probed)
  60. return -ENODEV;
  61. if (clk->id >= SANDBOX_CLK_ID_COUNT)
  62. return -EINVAL;
  63. priv->enabled[clk->id] = false;
  64. return 0;
  65. }
  66. static int sandbox_clk_request(struct clk *clk)
  67. {
  68. struct sandbox_clk_priv *priv = dev_get_priv(clk->dev);
  69. if (clk->id >= SANDBOX_CLK_ID_COUNT)
  70. return -EINVAL;
  71. priv->requested[clk->id] = true;
  72. return 0;
  73. }
  74. static int sandbox_clk_free(struct clk *clk)
  75. {
  76. struct sandbox_clk_priv *priv = dev_get_priv(clk->dev);
  77. if (clk->id >= SANDBOX_CLK_ID_COUNT)
  78. return -EINVAL;
  79. priv->requested[clk->id] = false;
  80. return 0;
  81. }
  82. static struct clk_ops sandbox_clk_ops = {
  83. .round_rate = sandbox_clk_round_rate,
  84. .get_rate = sandbox_clk_get_rate,
  85. .set_rate = sandbox_clk_set_rate,
  86. .enable = sandbox_clk_enable,
  87. .disable = sandbox_clk_disable,
  88. .request = sandbox_clk_request,
  89. .rfree = sandbox_clk_free,
  90. };
  91. static int sandbox_clk_probe(struct udevice *dev)
  92. {
  93. struct sandbox_clk_priv *priv = dev_get_priv(dev);
  94. priv->probed = true;
  95. return 0;
  96. }
  97. static const struct udevice_id sandbox_clk_ids[] = {
  98. { .compatible = "sandbox,clk" },
  99. { }
  100. };
  101. U_BOOT_DRIVER(sandbox_clk) = {
  102. .name = "sandbox_clk",
  103. .id = UCLASS_CLK,
  104. .of_match = sandbox_clk_ids,
  105. .ops = &sandbox_clk_ops,
  106. .probe = sandbox_clk_probe,
  107. .priv_auto = sizeof(struct sandbox_clk_priv),
  108. };
  109. ulong sandbox_clk_query_rate(struct udevice *dev, int id)
  110. {
  111. struct sandbox_clk_priv *priv = dev_get_priv(dev);
  112. if (id < 0 || id >= SANDBOX_CLK_ID_COUNT)
  113. return -EINVAL;
  114. return priv->rate[id];
  115. }
  116. int sandbox_clk_query_enable(struct udevice *dev, int id)
  117. {
  118. struct sandbox_clk_priv *priv = dev_get_priv(dev);
  119. if (id < 0 || id >= SANDBOX_CLK_ID_COUNT)
  120. return -EINVAL;
  121. return priv->enabled[id];
  122. }
  123. int sandbox_clk_query_requested(struct udevice *dev, int id)
  124. {
  125. struct sandbox_clk_priv *priv = dev_get_priv(dev);
  126. if (id < 0 || id >= SANDBOX_CLK_ID_COUNT)
  127. return -EINVAL;
  128. return priv->requested[id];
  129. }
  130. int clk_fixed_rate_of_to_plat(struct udevice *dev)
  131. {
  132. struct clk_fixed_rate *cplat;
  133. #if CONFIG_IS_ENABLED(OF_PLATDATA)
  134. struct sandbox_clk_fixed_rate_plat *plat = dev_get_plat(dev);
  135. cplat = &plat->fixed;
  136. cplat->fixed_rate = plat->dtplat.clock_frequency;
  137. #else
  138. cplat = to_clk_fixed_rate(dev);
  139. #endif
  140. clk_fixed_rate_ofdata_to_plat_(dev, cplat);
  141. return 0;
  142. }
  143. static const struct udevice_id sandbox_clk_fixed_rate_match[] = {
  144. { .compatible = "sandbox,fixed-clock" },
  145. { /* sentinel */ }
  146. };
  147. U_BOOT_DRIVER(sandbox_fixed_clock) = {
  148. .name = "sandbox_fixed_clock",
  149. .id = UCLASS_CLK,
  150. .of_match = sandbox_clk_fixed_rate_match,
  151. .of_to_plat = clk_fixed_rate_of_to_plat,
  152. .plat_auto = sizeof(struct sandbox_clk_fixed_rate_plat),
  153. .ops = &clk_fixed_rate_ops,
  154. .flags = DM_FLAG_PRE_RELOC,
  155. };