ti-sysc.c 3.1 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160
  1. // SPDX-License-Identifier: GPL-2.0+
  2. /*
  3. * Texas Instruments sysc interconnect target driver
  4. *
  5. * Copyright (C) 2020 Dario Binacchi <dariobin@libero.it>
  6. */
  7. #include <common.h>
  8. #include <clk.h>
  9. #include <dm.h>
  10. #include <dm/device_compat.h>
  11. enum ti_sysc_clocks {
  12. TI_SYSC_FCK,
  13. TI_SYSC_ICK,
  14. TI_SYSC_MAX_CLOCKS,
  15. };
  16. static const char *const clock_names[] = {"fck", "ick"};
  17. struct ti_sysc_priv {
  18. int clocks_count;
  19. struct clk clocks[TI_SYSC_MAX_CLOCKS];
  20. };
  21. static const struct udevice_id ti_sysc_ids[] = {
  22. {.compatible = "ti,sysc-omap2"},
  23. {.compatible = "ti,sysc-omap4"},
  24. {.compatible = "ti,sysc-omap4-simple"},
  25. {.compatible = "ti,sysc-omap3430-sr"},
  26. {.compatible = "ti,sysc-omap3630-sr"},
  27. {.compatible = "ti,sysc-omap4-sr"},
  28. {.compatible = "ti,sysc-omap3-sham"},
  29. {.compatible = "ti,sysc-omap-aes"},
  30. {.compatible = "ti,sysc-mcasp"},
  31. {.compatible = "ti,sysc-usb-host-fs"},
  32. {}
  33. };
  34. static int ti_sysc_get_one_clock(struct udevice *dev, enum ti_sysc_clocks index)
  35. {
  36. struct ti_sysc_priv *priv = dev_get_priv(dev);
  37. const char *name;
  38. int err;
  39. switch (index) {
  40. case TI_SYSC_FCK:
  41. break;
  42. case TI_SYSC_ICK:
  43. break;
  44. default:
  45. return -EINVAL;
  46. }
  47. name = clock_names[index];
  48. err = clk_get_by_name(dev, name, &priv->clocks[index]);
  49. if (err) {
  50. if (err == -ENODATA)
  51. return 0;
  52. dev_err(dev, "failed to get %s clock\n", name);
  53. return err;
  54. }
  55. return 0;
  56. }
  57. static int ti_sysc_put_clocks(struct udevice *dev)
  58. {
  59. struct ti_sysc_priv *priv = dev_get_priv(dev);
  60. int err;
  61. err = clk_release_all(priv->clocks, priv->clocks_count);
  62. if (err)
  63. dev_err(dev, "failed to release all clocks\n");
  64. return err;
  65. }
  66. static int ti_sysc_get_clocks(struct udevice *dev)
  67. {
  68. struct ti_sysc_priv *priv = dev_get_priv(dev);
  69. int i, err;
  70. for (i = 0; i < TI_SYSC_MAX_CLOCKS; i++) {
  71. err = ti_sysc_get_one_clock(dev, i);
  72. if (!err)
  73. priv->clocks_count++;
  74. else if (err != -ENOENT)
  75. return err;
  76. }
  77. return 0;
  78. }
  79. static int ti_sysc_child_post_remove(struct udevice *dev)
  80. {
  81. struct ti_sysc_priv *priv = dev_get_priv(dev->parent);
  82. int i, err;
  83. for (i = 0; i < priv->clocks_count; i++) {
  84. err = clk_disable(&priv->clocks[i]);
  85. if (err) {
  86. dev_err(dev->parent, "failed to disable %s clock\n",
  87. clock_names[i]);
  88. return err;
  89. }
  90. }
  91. return 0;
  92. }
  93. static int ti_sysc_child_pre_probe(struct udevice *dev)
  94. {
  95. struct ti_sysc_priv *priv = dev_get_priv(dev->parent);
  96. int i, err;
  97. for (i = 0; i < priv->clocks_count; i++) {
  98. err = clk_enable(&priv->clocks[i]);
  99. if (err) {
  100. dev_err(dev->parent, "failed to enable %s clock\n",
  101. clock_names[i]);
  102. return err;
  103. }
  104. }
  105. return 0;
  106. }
  107. static int ti_sysc_remove(struct udevice *dev)
  108. {
  109. return ti_sysc_put_clocks(dev);
  110. }
  111. static int ti_sysc_probe(struct udevice *dev)
  112. {
  113. int err;
  114. err = ti_sysc_get_clocks(dev);
  115. if (err)
  116. goto clocks_err;
  117. return 0;
  118. clocks_err:
  119. ti_sysc_put_clocks(dev);
  120. return err;
  121. }
  122. U_BOOT_DRIVER(ti_sysc) = {
  123. .name = "ti_sysc",
  124. .id = UCLASS_SIMPLE_BUS,
  125. .of_match = ti_sysc_ids,
  126. .probe = ti_sysc_probe,
  127. .remove = ti_sysc_remove,
  128. .child_pre_probe = ti_sysc_child_pre_probe,
  129. .child_post_remove = ti_sysc_child_post_remove,
  130. .priv_auto = sizeof(struct ti_sysc_priv)
  131. };