clk_sandbox.c 3.1 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162
  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 <asm/clk.h>
  10. struct sandbox_clk_priv {
  11. bool probed;
  12. ulong rate[SANDBOX_CLK_ID_COUNT];
  13. bool enabled[SANDBOX_CLK_ID_COUNT];
  14. bool requested[SANDBOX_CLK_ID_COUNT];
  15. };
  16. static ulong sandbox_clk_get_rate(struct clk *clk)
  17. {
  18. struct sandbox_clk_priv *priv = dev_get_priv(clk->dev);
  19. if (!priv->probed)
  20. return -ENODEV;
  21. if (clk->id >= SANDBOX_CLK_ID_COUNT)
  22. return -EINVAL;
  23. return priv->rate[clk->id];
  24. }
  25. static ulong sandbox_clk_set_rate(struct clk *clk, ulong rate)
  26. {
  27. struct sandbox_clk_priv *priv = dev_get_priv(clk->dev);
  28. ulong old_rate;
  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. old_rate = priv->rate[clk->id];
  36. priv->rate[clk->id] = rate;
  37. return old_rate;
  38. }
  39. static int sandbox_clk_enable(struct clk *clk)
  40. {
  41. struct sandbox_clk_priv *priv = dev_get_priv(clk->dev);
  42. if (!priv->probed)
  43. return -ENODEV;
  44. if (clk->id >= SANDBOX_CLK_ID_COUNT)
  45. return -EINVAL;
  46. priv->enabled[clk->id] = true;
  47. return 0;
  48. }
  49. static int sandbox_clk_disable(struct clk *clk)
  50. {
  51. struct sandbox_clk_priv *priv = dev_get_priv(clk->dev);
  52. if (!priv->probed)
  53. return -ENODEV;
  54. if (clk->id >= SANDBOX_CLK_ID_COUNT)
  55. return -EINVAL;
  56. priv->enabled[clk->id] = false;
  57. return 0;
  58. }
  59. static int sandbox_clk_request(struct clk *clk)
  60. {
  61. struct sandbox_clk_priv *priv = dev_get_priv(clk->dev);
  62. if (clk->id >= SANDBOX_CLK_ID_COUNT)
  63. return -EINVAL;
  64. priv->requested[clk->id] = true;
  65. return 0;
  66. }
  67. static int sandbox_clk_free(struct clk *clk)
  68. {
  69. struct sandbox_clk_priv *priv = dev_get_priv(clk->dev);
  70. if (clk->id >= SANDBOX_CLK_ID_COUNT)
  71. return -EINVAL;
  72. priv->requested[clk->id] = false;
  73. return 0;
  74. }
  75. static struct clk_ops sandbox_clk_ops = {
  76. .get_rate = sandbox_clk_get_rate,
  77. .set_rate = sandbox_clk_set_rate,
  78. .enable = sandbox_clk_enable,
  79. .disable = sandbox_clk_disable,
  80. .request = sandbox_clk_request,
  81. .rfree = sandbox_clk_free,
  82. };
  83. static int sandbox_clk_probe(struct udevice *dev)
  84. {
  85. struct sandbox_clk_priv *priv = dev_get_priv(dev);
  86. priv->probed = true;
  87. return 0;
  88. }
  89. static const struct udevice_id sandbox_clk_ids[] = {
  90. { .compatible = "sandbox,clk" },
  91. { }
  92. };
  93. U_BOOT_DRIVER(clk_sandbox) = {
  94. .name = "clk_sandbox",
  95. .id = UCLASS_CLK,
  96. .of_match = sandbox_clk_ids,
  97. .ops = &sandbox_clk_ops,
  98. .probe = sandbox_clk_probe,
  99. .priv_auto_alloc_size = sizeof(struct sandbox_clk_priv),
  100. };
  101. ulong sandbox_clk_query_rate(struct udevice *dev, int id)
  102. {
  103. struct sandbox_clk_priv *priv = dev_get_priv(dev);
  104. if (id < 0 || id >= SANDBOX_CLK_ID_COUNT)
  105. return -EINVAL;
  106. return priv->rate[id];
  107. }
  108. int sandbox_clk_query_enable(struct udevice *dev, int id)
  109. {
  110. struct sandbox_clk_priv *priv = dev_get_priv(dev);
  111. if (id < 0 || id >= SANDBOX_CLK_ID_COUNT)
  112. return -EINVAL;
  113. return priv->enabled[id];
  114. }
  115. int sandbox_clk_query_requested(struct udevice *dev, int id)
  116. {
  117. struct sandbox_clk_priv *priv = dev_get_priv(dev);
  118. if (id < 0 || id >= SANDBOX_CLK_ID_COUNT)
  119. return -EINVAL;
  120. return priv->requested[id];
  121. }