clk_sandbox.c 2.0 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106
  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. ulong rate[SANDBOX_CLK_ID_COUNT];
  12. bool enabled[SANDBOX_CLK_ID_COUNT];
  13. };
  14. static ulong sandbox_clk_get_rate(struct clk *clk)
  15. {
  16. struct sandbox_clk_priv *priv = dev_get_priv(clk->dev);
  17. if (clk->id >= SANDBOX_CLK_ID_COUNT)
  18. return -EINVAL;
  19. return priv->rate[clk->id];
  20. }
  21. static ulong sandbox_clk_set_rate(struct clk *clk, ulong rate)
  22. {
  23. struct sandbox_clk_priv *priv = dev_get_priv(clk->dev);
  24. ulong old_rate;
  25. if (clk->id >= SANDBOX_CLK_ID_COUNT)
  26. return -EINVAL;
  27. if (!rate)
  28. return -EINVAL;
  29. old_rate = priv->rate[clk->id];
  30. priv->rate[clk->id] = rate;
  31. return old_rate;
  32. }
  33. static int sandbox_clk_enable(struct clk *clk)
  34. {
  35. struct sandbox_clk_priv *priv = dev_get_priv(clk->dev);
  36. if (clk->id >= SANDBOX_CLK_ID_COUNT)
  37. return -EINVAL;
  38. priv->enabled[clk->id] = true;
  39. return 0;
  40. }
  41. static int sandbox_clk_disable(struct clk *clk)
  42. {
  43. struct sandbox_clk_priv *priv = dev_get_priv(clk->dev);
  44. if (clk->id >= SANDBOX_CLK_ID_COUNT)
  45. return -EINVAL;
  46. priv->enabled[clk->id] = false;
  47. return 0;
  48. }
  49. static struct clk_ops sandbox_clk_ops = {
  50. .get_rate = sandbox_clk_get_rate,
  51. .set_rate = sandbox_clk_set_rate,
  52. .enable = sandbox_clk_enable,
  53. .disable = sandbox_clk_disable,
  54. };
  55. static const struct udevice_id sandbox_clk_ids[] = {
  56. { .compatible = "sandbox,clk" },
  57. { }
  58. };
  59. U_BOOT_DRIVER(clk_sandbox) = {
  60. .name = "clk_sandbox",
  61. .id = UCLASS_CLK,
  62. .of_match = sandbox_clk_ids,
  63. .ops = &sandbox_clk_ops,
  64. .priv_auto_alloc_size = sizeof(struct sandbox_clk_priv),
  65. };
  66. ulong sandbox_clk_query_rate(struct udevice *dev, int id)
  67. {
  68. struct sandbox_clk_priv *priv = dev_get_priv(dev);
  69. if (id < 0 || id >= SANDBOX_CLK_ID_COUNT)
  70. return -EINVAL;
  71. return priv->rate[id];
  72. }
  73. int sandbox_clk_query_enable(struct udevice *dev, int id)
  74. {
  75. struct sandbox_clk_priv *priv = dev_get_priv(dev);
  76. if (id < 0 || id >= SANDBOX_CLK_ID_COUNT)
  77. return -EINVAL;
  78. return priv->enabled[id];
  79. }