ux500.c 3.7 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179
  1. // SPDX-License-Identifier: GPL-2.0+
  2. /* Copyright (C) 2019 Stephan Gerhold */
  3. #include <common.h>
  4. #include <dm.h>
  5. #include <generic-phy.h>
  6. #include <dm/device_compat.h>
  7. #include "musb_uboot.h"
  8. static struct musb_hdrc_config ux500_musb_hdrc_config = {
  9. .multipoint = true,
  10. .dyn_fifo = true,
  11. .num_eps = 16,
  12. .ram_bits = 16,
  13. };
  14. struct ux500_glue {
  15. struct musb_host_data mdata;
  16. struct device dev;
  17. struct phy phy;
  18. bool enabled;
  19. };
  20. #define to_ux500_glue(d) container_of(d, struct ux500_glue, dev)
  21. static int ux500_musb_enable(struct musb *musb)
  22. {
  23. struct ux500_glue *glue = to_ux500_glue(musb->controller);
  24. int ret;
  25. if (glue->enabled)
  26. return 0;
  27. ret = generic_phy_power_on(&glue->phy);
  28. if (ret) {
  29. printf("%s: failed to power on USB PHY\n", __func__);
  30. return ret;
  31. }
  32. glue->enabled = true;
  33. return 0;
  34. }
  35. static void ux500_musb_disable(struct musb *musb)
  36. {
  37. struct ux500_glue *glue = to_ux500_glue(musb->controller);
  38. int ret;
  39. if (!glue->enabled)
  40. return;
  41. ret = generic_phy_power_off(&glue->phy);
  42. if (ret) {
  43. printf("%s: failed to power off USB PHY\n", __func__);
  44. return;
  45. }
  46. glue->enabled = false;
  47. }
  48. static int ux500_musb_init(struct musb *musb)
  49. {
  50. struct ux500_glue *glue = to_ux500_glue(musb->controller);
  51. int ret;
  52. ret = generic_phy_init(&glue->phy);
  53. if (ret) {
  54. printf("%s: failed to init USB PHY\n", __func__);
  55. return ret;
  56. }
  57. return 0;
  58. }
  59. static int ux500_musb_exit(struct musb *musb)
  60. {
  61. struct ux500_glue *glue = to_ux500_glue(musb->controller);
  62. int ret;
  63. ret = generic_phy_exit(&glue->phy);
  64. if (ret) {
  65. printf("%s: failed to exit USB PHY\n", __func__);
  66. return ret;
  67. }
  68. return 0;
  69. }
  70. static const struct musb_platform_ops ux500_musb_ops = {
  71. .init = ux500_musb_init,
  72. .exit = ux500_musb_exit,
  73. .enable = ux500_musb_enable,
  74. .disable = ux500_musb_disable,
  75. };
  76. int dm_usb_gadget_handle_interrupts(struct udevice *dev)
  77. {
  78. struct ux500_glue *glue = dev_get_priv(dev);
  79. glue->mdata.host->isr(0, glue->mdata.host);
  80. return 0;
  81. }
  82. static int ux500_musb_probe(struct udevice *dev)
  83. {
  84. #ifdef CONFIG_USB_MUSB_HOST
  85. struct usb_bus_priv *priv = dev_get_uclass_priv(dev);
  86. #endif
  87. struct ux500_glue *glue = dev_get_priv(dev);
  88. struct musb_host_data *host = &glue->mdata;
  89. struct musb_hdrc_platform_data pdata;
  90. void *base = dev_read_addr_ptr(dev);
  91. int ret;
  92. if (!base)
  93. return -EINVAL;
  94. ret = generic_phy_get_by_name(dev, "usb", &glue->phy);
  95. if (ret) {
  96. dev_err(dev, "failed to get USB PHY: %d\n", ret);
  97. return ret;
  98. }
  99. memset(&pdata, 0, sizeof(pdata));
  100. pdata.platform_ops = &ux500_musb_ops;
  101. pdata.config = &ux500_musb_hdrc_config;
  102. #ifdef CONFIG_USB_MUSB_HOST
  103. priv->desc_before_addr = true;
  104. pdata.mode = MUSB_HOST;
  105. host->host = musb_init_controller(&pdata, &glue->dev, base);
  106. if (!host->host)
  107. return -EIO;
  108. return musb_lowlevel_init(host);
  109. #else
  110. pdata.mode = MUSB_PERIPHERAL;
  111. host->host = musb_init_controller(&pdata, &glue->dev, base);
  112. if (!host->host)
  113. return -EIO;
  114. return usb_add_gadget_udc(&glue->dev, &host->host->g);
  115. #endif
  116. }
  117. static int ux500_musb_remove(struct udevice *dev)
  118. {
  119. struct ux500_glue *glue = dev_get_priv(dev);
  120. struct musb_host_data *host = &glue->mdata;
  121. usb_del_gadget_udc(&host->host->g);
  122. musb_stop(host->host);
  123. free(host->host);
  124. host->host = NULL;
  125. return 0;
  126. }
  127. static const struct udevice_id ux500_musb_ids[] = {
  128. { .compatible = "stericsson,db8500-musb" },
  129. { }
  130. };
  131. U_BOOT_DRIVER(ux500_musb) = {
  132. .name = "ux500-musb",
  133. #ifdef CONFIG_USB_MUSB_HOST
  134. .id = UCLASS_USB,
  135. #else
  136. .id = UCLASS_USB_GADGET_GENERIC,
  137. #endif
  138. .of_match = ux500_musb_ids,
  139. .probe = ux500_musb_probe,
  140. .remove = ux500_musb_remove,
  141. #ifdef CONFIG_USB_MUSB_HOST
  142. .ops = &musb_usb_ops,
  143. #endif
  144. .plat_auto = sizeof(struct usb_plat),
  145. .priv_auto = sizeof(struct ux500_glue),
  146. };