clk_sandbox.c 3.1 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163
  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_set_rate(struct clk *clk, ulong rate)
  27. {
  28. struct sandbox_clk_priv *priv = dev_get_priv(clk->dev);
  29. ulong old_rate;
  30. if (!priv->probed)
  31. return -ENODEV;
  32. if (clk->id >= SANDBOX_CLK_ID_COUNT)
  33. return -EINVAL;
  34. if (!rate)
  35. return -EINVAL;
  36. old_rate = priv->rate[clk->id];
  37. priv->rate[clk->id] = rate;
  38. return old_rate;
  39. }
  40. static int sandbox_clk_enable(struct clk *clk)
  41. {
  42. struct sandbox_clk_priv *priv = dev_get_priv(clk->dev);
  43. if (!priv->probed)
  44. return -ENODEV;
  45. if (clk->id >= SANDBOX_CLK_ID_COUNT)
  46. return -EINVAL;
  47. priv->enabled[clk->id] = true;
  48. return 0;
  49. }
  50. static int sandbox_clk_disable(struct clk *clk)
  51. {
  52. struct sandbox_clk_priv *priv = dev_get_priv(clk->dev);
  53. if (!priv->probed)
  54. return -ENODEV;
  55. if (clk->id >= SANDBOX_CLK_ID_COUNT)
  56. return -EINVAL;
  57. priv->enabled[clk->id] = false;
  58. return 0;
  59. }
  60. static int sandbox_clk_request(struct clk *clk)
  61. {
  62. struct sandbox_clk_priv *priv = dev_get_priv(clk->dev);
  63. if (clk->id >= SANDBOX_CLK_ID_COUNT)
  64. return -EINVAL;
  65. priv->requested[clk->id] = true;
  66. return 0;
  67. }
  68. static int sandbox_clk_free(struct clk *clk)
  69. {
  70. struct sandbox_clk_priv *priv = dev_get_priv(clk->dev);
  71. if (clk->id >= SANDBOX_CLK_ID_COUNT)
  72. return -EINVAL;
  73. priv->requested[clk->id] = false;
  74. return 0;
  75. }
  76. static struct clk_ops sandbox_clk_ops = {
  77. .get_rate = sandbox_clk_get_rate,
  78. .set_rate = sandbox_clk_set_rate,
  79. .enable = sandbox_clk_enable,
  80. .disable = sandbox_clk_disable,
  81. .request = sandbox_clk_request,
  82. .rfree = sandbox_clk_free,
  83. };
  84. static int sandbox_clk_probe(struct udevice *dev)
  85. {
  86. struct sandbox_clk_priv *priv = dev_get_priv(dev);
  87. priv->probed = true;
  88. return 0;
  89. }
  90. static const struct udevice_id sandbox_clk_ids[] = {
  91. { .compatible = "sandbox,clk" },
  92. { }
  93. };
  94. U_BOOT_DRIVER(sandbox_clk) = {
  95. .name = "sandbox_clk",
  96. .id = UCLASS_CLK,
  97. .of_match = sandbox_clk_ids,
  98. .ops = &sandbox_clk_ops,
  99. .probe = sandbox_clk_probe,
  100. .priv_auto_alloc_size = sizeof(struct sandbox_clk_priv),
  101. };
  102. ulong sandbox_clk_query_rate(struct udevice *dev, int id)
  103. {
  104. struct sandbox_clk_priv *priv = dev_get_priv(dev);
  105. if (id < 0 || id >= SANDBOX_CLK_ID_COUNT)
  106. return -EINVAL;
  107. return priv->rate[id];
  108. }
  109. int sandbox_clk_query_enable(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->enabled[id];
  115. }
  116. int sandbox_clk_query_requested(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->requested[id];
  122. }