clk_sandbox_test.c 2.1 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101
  1. /*
  2. * Copyright (c) 2016, NVIDIA CORPORATION.
  3. *
  4. * SPDX-License-Identifier: GPL-2.0
  5. */
  6. #include <common.h>
  7. #include <dm.h>
  8. #include <clk.h>
  9. #include <asm/clk.h>
  10. struct sandbox_clk_test {
  11. struct clk clks[SANDBOX_CLK_TEST_ID_COUNT];
  12. };
  13. static const char * const sandbox_clk_test_names[] = {
  14. [SANDBOX_CLK_TEST_ID_FIXED] = "fixed",
  15. [SANDBOX_CLK_TEST_ID_SPI] = "spi",
  16. [SANDBOX_CLK_TEST_ID_I2C] = "i2c",
  17. };
  18. int sandbox_clk_test_get(struct udevice *dev)
  19. {
  20. struct sandbox_clk_test *sbct = dev_get_priv(dev);
  21. int i, ret;
  22. for (i = 0; i < SANDBOX_CLK_TEST_ID_COUNT; i++) {
  23. ret = clk_get_by_name(dev, sandbox_clk_test_names[i],
  24. &sbct->clks[i]);
  25. if (ret)
  26. return ret;
  27. }
  28. return 0;
  29. }
  30. ulong sandbox_clk_test_get_rate(struct udevice *dev, int id)
  31. {
  32. struct sandbox_clk_test *sbct = dev_get_priv(dev);
  33. if (id < 0 || id >= SANDBOX_CLK_TEST_ID_COUNT)
  34. return -EINVAL;
  35. return clk_get_rate(&sbct->clks[id]);
  36. }
  37. ulong sandbox_clk_test_set_rate(struct udevice *dev, int id, ulong rate)
  38. {
  39. struct sandbox_clk_test *sbct = dev_get_priv(dev);
  40. if (id < 0 || id >= SANDBOX_CLK_TEST_ID_COUNT)
  41. return -EINVAL;
  42. return clk_set_rate(&sbct->clks[id], rate);
  43. }
  44. int sandbox_clk_test_enable(struct udevice *dev, int id)
  45. {
  46. struct sandbox_clk_test *sbct = dev_get_priv(dev);
  47. if (id < 0 || id >= SANDBOX_CLK_TEST_ID_COUNT)
  48. return -EINVAL;
  49. return clk_enable(&sbct->clks[id]);
  50. }
  51. int sandbox_clk_test_disable(struct udevice *dev, int id)
  52. {
  53. struct sandbox_clk_test *sbct = dev_get_priv(dev);
  54. if (id < 0 || id >= SANDBOX_CLK_TEST_ID_COUNT)
  55. return -EINVAL;
  56. return clk_disable(&sbct->clks[id]);
  57. }
  58. int sandbox_clk_test_free(struct udevice *dev)
  59. {
  60. struct sandbox_clk_test *sbct = dev_get_priv(dev);
  61. int i, ret;
  62. for (i = 0; i < SANDBOX_CLK_TEST_ID_COUNT; i++) {
  63. ret = clk_free(&sbct->clks[i]);
  64. if (ret)
  65. return ret;
  66. }
  67. return 0;
  68. }
  69. static const struct udevice_id sandbox_clk_test_ids[] = {
  70. { .compatible = "sandbox,clk-test" },
  71. { }
  72. };
  73. U_BOOT_DRIVER(sandbox_clk_test) = {
  74. .name = "sandbox_clk_test",
  75. .id = UCLASS_MISC,
  76. .of_match = sandbox_clk_test_ids,
  77. .priv_auto_alloc_size = sizeof(struct sandbox_clk_test),
  78. };