ohci-sm501.c 6.8 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268
  1. /*
  2. * OHCI HCD (Host Controller Driver) for USB.
  3. *
  4. * (C) Copyright 1999 Roman Weissgaerber <weissg@vienna.at>
  5. * (C) Copyright 2000-2005 David Brownell
  6. * (C) Copyright 2002 Hewlett-Packard Company
  7. * (C) Copyright 2008 Magnus Damm
  8. *
  9. * SM501 Bus Glue - based on ohci-omap.c
  10. *
  11. * This file is licenced under the GPL.
  12. */
  13. #include <linux/interrupt.h>
  14. #include <linux/jiffies.h>
  15. #include <linux/platform_device.h>
  16. #include <linux/dma-mapping.h>
  17. #include <linux/sm501.h>
  18. #include <linux/sm501-regs.h>
  19. static int ohci_sm501_init(struct usb_hcd *hcd)
  20. {
  21. return ohci_init(hcd_to_ohci(hcd));
  22. }
  23. static int ohci_sm501_start(struct usb_hcd *hcd)
  24. {
  25. struct device *dev = hcd->self.controller;
  26. int ret;
  27. ret = ohci_run(hcd_to_ohci(hcd));
  28. if (ret < 0) {
  29. dev_err(dev, "can't start %s", hcd->self.bus_name);
  30. ohci_stop(hcd);
  31. }
  32. return ret;
  33. }
  34. /*-------------------------------------------------------------------------*/
  35. static const struct hc_driver ohci_sm501_hc_driver = {
  36. .description = hcd_name,
  37. .product_desc = "SM501 OHCI",
  38. .hcd_priv_size = sizeof(struct ohci_hcd),
  39. /*
  40. * generic hardware linkage
  41. */
  42. .irq = ohci_irq,
  43. .flags = HCD_USB11 | HCD_MEMORY | HCD_LOCAL_MEM,
  44. /*
  45. * basic lifecycle operations
  46. */
  47. .reset = ohci_sm501_init,
  48. .start = ohci_sm501_start,
  49. .stop = ohci_stop,
  50. .shutdown = ohci_shutdown,
  51. /*
  52. * managing i/o requests and associated device resources
  53. */
  54. .urb_enqueue = ohci_urb_enqueue,
  55. .urb_dequeue = ohci_urb_dequeue,
  56. .endpoint_disable = ohci_endpoint_disable,
  57. /*
  58. * scheduling support
  59. */
  60. .get_frame_number = ohci_get_frame,
  61. /*
  62. * root hub support
  63. */
  64. .hub_status_data = ohci_hub_status_data,
  65. .hub_control = ohci_hub_control,
  66. #ifdef CONFIG_PM
  67. .bus_suspend = ohci_bus_suspend,
  68. .bus_resume = ohci_bus_resume,
  69. #endif
  70. .start_port_reset = ohci_start_port_reset,
  71. };
  72. /*-------------------------------------------------------------------------*/
  73. static int ohci_hcd_sm501_drv_probe(struct platform_device *pdev)
  74. {
  75. const struct hc_driver *driver = &ohci_sm501_hc_driver;
  76. struct device *dev = &pdev->dev;
  77. struct resource *res, *mem;
  78. int retval, irq;
  79. struct usb_hcd *hcd = NULL;
  80. irq = retval = platform_get_irq(pdev, 0);
  81. if (retval < 0)
  82. goto err0;
  83. mem = platform_get_resource(pdev, IORESOURCE_MEM, 1);
  84. if (mem == NULL) {
  85. dev_err(dev, "no resource definition for memory\n");
  86. retval = -ENOENT;
  87. goto err0;
  88. }
  89. if (!request_mem_region(mem->start, mem->end - mem->start + 1,
  90. pdev->name)) {
  91. dev_err(dev, "request_mem_region failed\n");
  92. retval = -EBUSY;
  93. goto err0;
  94. }
  95. /* The sm501 chip is equipped with local memory that may be used
  96. * by on-chip devices such as the video controller and the usb host.
  97. * This driver uses dma_declare_coherent_memory() to make sure
  98. * usb allocations with dma_alloc_coherent() allocate from
  99. * this local memory. The dma_handle returned by dma_alloc_coherent()
  100. * will be an offset starting from 0 for the first local memory byte.
  101. *
  102. * So as long as data is allocated using dma_alloc_coherent() all is
  103. * fine. This is however not always the case - buffers may be allocated
  104. * using kmalloc() - so the usb core needs to be told that it must copy
  105. * data into our local memory if the buffers happen to be placed in
  106. * regular memory. The HCD_LOCAL_MEM flag does just that.
  107. */
  108. if (!dma_declare_coherent_memory(dev, mem->start,
  109. mem->start - mem->parent->start,
  110. (mem->end - mem->start) + 1,
  111. DMA_MEMORY_MAP |
  112. DMA_MEMORY_EXCLUSIVE)) {
  113. dev_err(dev, "cannot declare coherent memory\n");
  114. retval = -ENXIO;
  115. goto err1;
  116. }
  117. /* allocate, reserve and remap resources for registers */
  118. res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
  119. if (res == NULL) {
  120. dev_err(dev, "no resource definition for registers\n");
  121. retval = -ENOENT;
  122. goto err2;
  123. }
  124. hcd = usb_create_hcd(driver, &pdev->dev, dev_name(&pdev->dev));
  125. if (!hcd) {
  126. retval = -ENOMEM;
  127. goto err2;
  128. }
  129. hcd->rsrc_start = res->start;
  130. hcd->rsrc_len = res->end - res->start + 1;
  131. if (!request_mem_region(hcd->rsrc_start, hcd->rsrc_len, pdev->name)) {
  132. dev_err(dev, "request_mem_region failed\n");
  133. retval = -EBUSY;
  134. goto err3;
  135. }
  136. hcd->regs = ioremap(hcd->rsrc_start, hcd->rsrc_len);
  137. if (hcd->regs == NULL) {
  138. dev_err(dev, "cannot remap registers\n");
  139. retval = -ENXIO;
  140. goto err4;
  141. }
  142. ohci_hcd_init(hcd_to_ohci(hcd));
  143. retval = usb_add_hcd(hcd, irq, IRQF_DISABLED | IRQF_SHARED);
  144. if (retval)
  145. goto err5;
  146. /* enable power and unmask interrupts */
  147. sm501_unit_power(dev->parent, SM501_GATE_USB_HOST, 1);
  148. sm501_modify_reg(dev->parent, SM501_IRQ_MASK, 1 << 6, 0);
  149. return 0;
  150. err5:
  151. iounmap(hcd->regs);
  152. err4:
  153. release_mem_region(hcd->rsrc_start, hcd->rsrc_len);
  154. err3:
  155. usb_put_hcd(hcd);
  156. err2:
  157. dma_release_declared_memory(dev);
  158. err1:
  159. release_mem_region(mem->start, mem->end - mem->start + 1);
  160. err0:
  161. return retval;
  162. }
  163. static int ohci_hcd_sm501_drv_remove(struct platform_device *pdev)
  164. {
  165. struct usb_hcd *hcd = platform_get_drvdata(pdev);
  166. struct resource *mem;
  167. usb_remove_hcd(hcd);
  168. release_mem_region(hcd->rsrc_start, hcd->rsrc_len);
  169. usb_put_hcd(hcd);
  170. dma_release_declared_memory(&pdev->dev);
  171. mem = platform_get_resource(pdev, IORESOURCE_MEM, 1);
  172. if (mem)
  173. release_mem_region(mem->start, mem->end - mem->start + 1);
  174. /* mask interrupts and disable power */
  175. sm501_modify_reg(pdev->dev.parent, SM501_IRQ_MASK, 0, 1 << 6);
  176. sm501_unit_power(pdev->dev.parent, SM501_GATE_USB_HOST, 0);
  177. platform_set_drvdata(pdev, NULL);
  178. return 0;
  179. }
  180. /*-------------------------------------------------------------------------*/
  181. #ifdef CONFIG_PM
  182. static int ohci_sm501_suspend(struct platform_device *pdev, pm_message_t msg)
  183. {
  184. struct device *dev = &pdev->dev;
  185. struct ohci_hcd *ohci = hcd_to_ohci(platform_get_drvdata(pdev));
  186. if (time_before(jiffies, ohci->next_statechange))
  187. msleep(5);
  188. ohci->next_statechange = jiffies;
  189. sm501_unit_power(dev->parent, SM501_GATE_USB_HOST, 0);
  190. ohci_to_hcd(ohci)->state = HC_STATE_SUSPENDED;
  191. return 0;
  192. }
  193. static int ohci_sm501_resume(struct platform_device *pdev)
  194. {
  195. struct device *dev = &pdev->dev;
  196. struct usb_hcd *hcd = platform_get_drvdata(pdev);
  197. struct ohci_hcd *ohci = hcd_to_ohci(hcd);
  198. if (time_before(jiffies, ohci->next_statechange))
  199. msleep(5);
  200. ohci->next_statechange = jiffies;
  201. sm501_unit_power(dev->parent, SM501_GATE_USB_HOST, 1);
  202. ohci_finish_controller_resume(hcd);
  203. return 0;
  204. }
  205. #else
  206. #define ohci_sm501_suspend NULL
  207. #define ohci_sm501_resume NULL
  208. #endif
  209. /*-------------------------------------------------------------------------*/
  210. /*
  211. * Driver definition to register with the SM501 bus
  212. */
  213. static struct platform_driver ohci_hcd_sm501_driver = {
  214. .probe = ohci_hcd_sm501_drv_probe,
  215. .remove = ohci_hcd_sm501_drv_remove,
  216. .shutdown = usb_hcd_platform_shutdown,
  217. .suspend = ohci_sm501_suspend,
  218. .resume = ohci_sm501_resume,
  219. .driver = {
  220. .owner = THIS_MODULE,
  221. .name = "sm501-usb",
  222. },
  223. };
  224. MODULE_ALIAS("platform:sm501-usb");