clk_scmi.c 2.1 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899
  1. // SPDX-License-Identifier: GPL-2.0+
  2. /*
  3. * Copyright (C) 2019-2020 Linaro Limited
  4. */
  5. #include <common.h>
  6. #include <clk-uclass.h>
  7. #include <dm.h>
  8. #include <scmi_agent.h>
  9. #include <scmi_protocols.h>
  10. #include <asm/types.h>
  11. static int scmi_clk_gate(struct clk *clk, int enable)
  12. {
  13. struct scmi_clk_state_in in = {
  14. .clock_id = clk->id,
  15. .attributes = enable,
  16. };
  17. struct scmi_clk_state_out out;
  18. struct scmi_msg msg = SCMI_MSG_IN(SCMI_PROTOCOL_ID_CLOCK,
  19. SCMI_CLOCK_CONFIG_SET,
  20. in, out);
  21. int ret;
  22. ret = devm_scmi_process_msg(clk->dev->parent, &msg);
  23. if (ret)
  24. return ret;
  25. return scmi_to_linux_errno(out.status);
  26. }
  27. static int scmi_clk_enable(struct clk *clk)
  28. {
  29. return scmi_clk_gate(clk, 1);
  30. }
  31. static int scmi_clk_disable(struct clk *clk)
  32. {
  33. return scmi_clk_gate(clk, 0);
  34. }
  35. static ulong scmi_clk_get_rate(struct clk *clk)
  36. {
  37. struct scmi_clk_rate_get_in in = {
  38. .clock_id = clk->id,
  39. };
  40. struct scmi_clk_rate_get_out out;
  41. struct scmi_msg msg = SCMI_MSG_IN(SCMI_PROTOCOL_ID_CLOCK,
  42. SCMI_CLOCK_RATE_GET,
  43. in, out);
  44. int ret;
  45. ret = devm_scmi_process_msg(clk->dev->parent, &msg);
  46. if (ret < 0)
  47. return ret;
  48. ret = scmi_to_linux_errno(out.status);
  49. if (ret < 0)
  50. return ret;
  51. return (ulong)(((u64)out.rate_msb << 32) | out.rate_lsb);
  52. }
  53. static ulong scmi_clk_set_rate(struct clk *clk, ulong rate)
  54. {
  55. struct scmi_clk_rate_set_in in = {
  56. .clock_id = clk->id,
  57. .flags = SCMI_CLK_RATE_ROUND_CLOSEST,
  58. .rate_lsb = (u32)rate,
  59. .rate_msb = (u32)((u64)rate >> 32),
  60. };
  61. struct scmi_clk_rate_set_out out;
  62. struct scmi_msg msg = SCMI_MSG_IN(SCMI_PROTOCOL_ID_CLOCK,
  63. SCMI_CLOCK_RATE_SET,
  64. in, out);
  65. int ret;
  66. ret = devm_scmi_process_msg(clk->dev->parent, &msg);
  67. if (ret < 0)
  68. return ret;
  69. ret = scmi_to_linux_errno(out.status);
  70. if (ret < 0)
  71. return ret;
  72. return scmi_clk_get_rate(clk);
  73. }
  74. static const struct clk_ops scmi_clk_ops = {
  75. .enable = scmi_clk_enable,
  76. .disable = scmi_clk_disable,
  77. .get_rate = scmi_clk_get_rate,
  78. .set_rate = scmi_clk_set_rate,
  79. };
  80. U_BOOT_DRIVER(scmi_clock) = {
  81. .name = "scmi_clk",
  82. .id = UCLASS_CLK,
  83. .ops = &scmi_clk_ops,
  84. };