ehci-au1xxx.c revision 807fcb5e19877d339a4cc56f2c6ddaf3a147457a
176fa9a240de4294a097235c9ddd470c21eb3449eJordan Crouse/* 276fa9a240de4294a097235c9ddd470c21eb3449eJordan Crouse * EHCI HCD (Host Controller Driver) for USB. 376fa9a240de4294a097235c9ddd470c21eb3449eJordan Crouse * 476fa9a240de4294a097235c9ddd470c21eb3449eJordan Crouse * Bus Glue for AMD Alchemy Au1xxx 576fa9a240de4294a097235c9ddd470c21eb3449eJordan Crouse * 676fa9a240de4294a097235c9ddd470c21eb3449eJordan Crouse * Based on "ohci-au1xxx.c" by Matt Porter <mporter@kernel.crashing.org> 776fa9a240de4294a097235c9ddd470c21eb3449eJordan Crouse * 876fa9a240de4294a097235c9ddd470c21eb3449eJordan Crouse * Modified for AMD Alchemy Au1200 EHC 976fa9a240de4294a097235c9ddd470c21eb3449eJordan Crouse * by K.Boge <karsten.boge@amd.com> 1076fa9a240de4294a097235c9ddd470c21eb3449eJordan Crouse * 1176fa9a240de4294a097235c9ddd470c21eb3449eJordan Crouse * This file is licenced under the GPL. 1276fa9a240de4294a097235c9ddd470c21eb3449eJordan Crouse */ 1376fa9a240de4294a097235c9ddd470c21eb3449eJordan Crouse 1476fa9a240de4294a097235c9ddd470c21eb3449eJordan Crouse#include <linux/platform_device.h> 1576fa9a240de4294a097235c9ddd470c21eb3449eJordan Crouse#include <asm/mach-au1x00/au1000.h> 1676fa9a240de4294a097235c9ddd470c21eb3449eJordan Crouse 1776fa9a240de4294a097235c9ddd470c21eb3449eJordan Crouse#define USB_HOST_CONFIG (USB_MSR_BASE + USB_MSR_MCFG) 1876fa9a240de4294a097235c9ddd470c21eb3449eJordan Crouse#define USB_MCFG_PFEN (1<<31) 1976fa9a240de4294a097235c9ddd470c21eb3449eJordan Crouse#define USB_MCFG_RDCOMB (1<<30) 2076fa9a240de4294a097235c9ddd470c21eb3449eJordan Crouse#define USB_MCFG_SSDEN (1<<23) 2176fa9a240de4294a097235c9ddd470c21eb3449eJordan Crouse#define USB_MCFG_PHYPLLEN (1<<19) 2253c81a348fa1d21dd042d9c9a9f91795f83fed66Manuel Lauss#define USB_MCFG_UCECLKEN (1<<18) 2376fa9a240de4294a097235c9ddd470c21eb3449eJordan Crouse#define USB_MCFG_EHCCLKEN (1<<17) 2453c81a348fa1d21dd042d9c9a9f91795f83fed66Manuel Lauss#ifdef CONFIG_DMA_COHERENT 2576fa9a240de4294a097235c9ddd470c21eb3449eJordan Crouse#define USB_MCFG_UCAM (1<<7) 2653c81a348fa1d21dd042d9c9a9f91795f83fed66Manuel Lauss#else 2753c81a348fa1d21dd042d9c9a9f91795f83fed66Manuel Lauss#define USB_MCFG_UCAM (0) 2853c81a348fa1d21dd042d9c9a9f91795f83fed66Manuel Lauss#endif 2976fa9a240de4294a097235c9ddd470c21eb3449eJordan Crouse#define USB_MCFG_EBMEN (1<<3) 3076fa9a240de4294a097235c9ddd470c21eb3449eJordan Crouse#define USB_MCFG_EMEMEN (1<<2) 3176fa9a240de4294a097235c9ddd470c21eb3449eJordan Crouse 3253c81a348fa1d21dd042d9c9a9f91795f83fed66Manuel Lauss#define USBH_ENABLE_CE (USB_MCFG_PHYPLLEN | USB_MCFG_EHCCLKEN) 3353c81a348fa1d21dd042d9c9a9f91795f83fed66Manuel Lauss#define USBH_ENABLE_INIT (USB_MCFG_PFEN | USB_MCFG_RDCOMB | \ 3453c81a348fa1d21dd042d9c9a9f91795f83fed66Manuel Lauss USBH_ENABLE_CE | USB_MCFG_SSDEN | \ 3553c81a348fa1d21dd042d9c9a9f91795f83fed66Manuel Lauss USB_MCFG_UCAM | USB_MCFG_EBMEN | \ 3653c81a348fa1d21dd042d9c9a9f91795f83fed66Manuel Lauss USB_MCFG_EMEMEN) 3776fa9a240de4294a097235c9ddd470c21eb3449eJordan Crouse 3876fa9a240de4294a097235c9ddd470c21eb3449eJordan Crouse#define USBH_DISABLE (USB_MCFG_EBMEN | USB_MCFG_EMEMEN) 3976fa9a240de4294a097235c9ddd470c21eb3449eJordan Crouse 4076fa9a240de4294a097235c9ddd470c21eb3449eJordan Crouseextern int usb_disabled(void); 4176fa9a240de4294a097235c9ddd470c21eb3449eJordan Crouse 4253c81a348fa1d21dd042d9c9a9f91795f83fed66Manuel Laussstatic void au1xxx_start_ehc(void) 4376fa9a240de4294a097235c9ddd470c21eb3449eJordan Crouse{ 4453c81a348fa1d21dd042d9c9a9f91795f83fed66Manuel Lauss /* enable clock to EHCI block and HS PHY PLL*/ 4553c81a348fa1d21dd042d9c9a9f91795f83fed66Manuel Lauss au_writel(au_readl(USB_HOST_CONFIG) | USBH_ENABLE_CE, USB_HOST_CONFIG); 4653c81a348fa1d21dd042d9c9a9f91795f83fed66Manuel Lauss au_sync(); 4776fa9a240de4294a097235c9ddd470c21eb3449eJordan Crouse udelay(1000); 4876fa9a240de4294a097235c9ddd470c21eb3449eJordan Crouse 4953c81a348fa1d21dd042d9c9a9f91795f83fed66Manuel Lauss /* enable EHCI mmio */ 5053c81a348fa1d21dd042d9c9a9f91795f83fed66Manuel Lauss au_writel(au_readl(USB_HOST_CONFIG) | USBH_ENABLE_INIT, USB_HOST_CONFIG); 5153c81a348fa1d21dd042d9c9a9f91795f83fed66Manuel Lauss au_sync(); 5253c81a348fa1d21dd042d9c9a9f91795f83fed66Manuel Lauss udelay(1000); 5376fa9a240de4294a097235c9ddd470c21eb3449eJordan Crouse} 5476fa9a240de4294a097235c9ddd470c21eb3449eJordan Crouse 5553c81a348fa1d21dd042d9c9a9f91795f83fed66Manuel Laussstatic void au1xxx_stop_ehc(void) 5676fa9a240de4294a097235c9ddd470c21eb3449eJordan Crouse{ 5753c81a348fa1d21dd042d9c9a9f91795f83fed66Manuel Lauss unsigned long c; 5876fa9a240de4294a097235c9ddd470c21eb3449eJordan Crouse 5976fa9a240de4294a097235c9ddd470c21eb3449eJordan Crouse /* Disable mem */ 6053c81a348fa1d21dd042d9c9a9f91795f83fed66Manuel Lauss au_writel(au_readl(USB_HOST_CONFIG) & ~USBH_DISABLE, USB_HOST_CONFIG); 6153c81a348fa1d21dd042d9c9a9f91795f83fed66Manuel Lauss au_sync(); 6276fa9a240de4294a097235c9ddd470c21eb3449eJordan Crouse udelay(1000); 6353c81a348fa1d21dd042d9c9a9f91795f83fed66Manuel Lauss 6453c81a348fa1d21dd042d9c9a9f91795f83fed66Manuel Lauss /* Disable EHC clock. If the HS PHY is unused disable it too. */ 6553c81a348fa1d21dd042d9c9a9f91795f83fed66Manuel Lauss c = au_readl(USB_HOST_CONFIG) & ~USB_MCFG_EHCCLKEN; 6653c81a348fa1d21dd042d9c9a9f91795f83fed66Manuel Lauss if (!(c & USB_MCFG_UCECLKEN)) /* UDC disabled? */ 6753c81a348fa1d21dd042d9c9a9f91795f83fed66Manuel Lauss c &= ~USB_MCFG_PHYPLLEN; /* yes: disable HS PHY PLL */ 6853c81a348fa1d21dd042d9c9a9f91795f83fed66Manuel Lauss au_writel(c, USB_HOST_CONFIG); 6953c81a348fa1d21dd042d9c9a9f91795f83fed66Manuel Lauss au_sync(); 7076fa9a240de4294a097235c9ddd470c21eb3449eJordan Crouse} 7176fa9a240de4294a097235c9ddd470c21eb3449eJordan Crouse 7253c81a348fa1d21dd042d9c9a9f91795f83fed66Manuel Laussstatic const struct hc_driver ehci_au1xxx_hc_driver = { 7353c81a348fa1d21dd042d9c9a9f91795f83fed66Manuel Lauss .description = hcd_name, 7453c81a348fa1d21dd042d9c9a9f91795f83fed66Manuel Lauss .product_desc = "Au1xxx EHCI", 7553c81a348fa1d21dd042d9c9a9f91795f83fed66Manuel Lauss .hcd_priv_size = sizeof(struct ehci_hcd), 7676fa9a240de4294a097235c9ddd470c21eb3449eJordan Crouse 7753c81a348fa1d21dd042d9c9a9f91795f83fed66Manuel Lauss /* 7853c81a348fa1d21dd042d9c9a9f91795f83fed66Manuel Lauss * generic hardware linkage 7953c81a348fa1d21dd042d9c9a9f91795f83fed66Manuel Lauss */ 8053c81a348fa1d21dd042d9c9a9f91795f83fed66Manuel Lauss .irq = ehci_irq, 8153c81a348fa1d21dd042d9c9a9f91795f83fed66Manuel Lauss .flags = HCD_MEMORY | HCD_USB2, 8276fa9a240de4294a097235c9ddd470c21eb3449eJordan Crouse 8353c81a348fa1d21dd042d9c9a9f91795f83fed66Manuel Lauss /* 8453c81a348fa1d21dd042d9c9a9f91795f83fed66Manuel Lauss * basic lifecycle operations 8553c81a348fa1d21dd042d9c9a9f91795f83fed66Manuel Lauss * 8653c81a348fa1d21dd042d9c9a9f91795f83fed66Manuel Lauss * FIXME -- ehci_init() doesn't do enough here. 8753c81a348fa1d21dd042d9c9a9f91795f83fed66Manuel Lauss * See ehci-ppc-soc for a complete implementation. 8853c81a348fa1d21dd042d9c9a9f91795f83fed66Manuel Lauss */ 8953c81a348fa1d21dd042d9c9a9f91795f83fed66Manuel Lauss .reset = ehci_init, 9053c81a348fa1d21dd042d9c9a9f91795f83fed66Manuel Lauss .start = ehci_run, 9153c81a348fa1d21dd042d9c9a9f91795f83fed66Manuel Lauss .stop = ehci_stop, 9253c81a348fa1d21dd042d9c9a9f91795f83fed66Manuel Lauss .shutdown = ehci_shutdown, 9353c81a348fa1d21dd042d9c9a9f91795f83fed66Manuel Lauss 9453c81a348fa1d21dd042d9c9a9f91795f83fed66Manuel Lauss /* 9553c81a348fa1d21dd042d9c9a9f91795f83fed66Manuel Lauss * managing i/o requests and associated device resources 9653c81a348fa1d21dd042d9c9a9f91795f83fed66Manuel Lauss */ 9753c81a348fa1d21dd042d9c9a9f91795f83fed66Manuel Lauss .urb_enqueue = ehci_urb_enqueue, 9853c81a348fa1d21dd042d9c9a9f91795f83fed66Manuel Lauss .urb_dequeue = ehci_urb_dequeue, 9953c81a348fa1d21dd042d9c9a9f91795f83fed66Manuel Lauss .endpoint_disable = ehci_endpoint_disable, 100b18ffd49e86102a9ed0a1cc83fdafe3891e844e5Alan Stern .endpoint_reset = ehci_endpoint_reset, 10153c81a348fa1d21dd042d9c9a9f91795f83fed66Manuel Lauss 10253c81a348fa1d21dd042d9c9a9f91795f83fed66Manuel Lauss /* 10353c81a348fa1d21dd042d9c9a9f91795f83fed66Manuel Lauss * scheduling support 10453c81a348fa1d21dd042d9c9a9f91795f83fed66Manuel Lauss */ 10553c81a348fa1d21dd042d9c9a9f91795f83fed66Manuel Lauss .get_frame_number = ehci_get_frame, 10653c81a348fa1d21dd042d9c9a9f91795f83fed66Manuel Lauss 10753c81a348fa1d21dd042d9c9a9f91795f83fed66Manuel Lauss /* 10853c81a348fa1d21dd042d9c9a9f91795f83fed66Manuel Lauss * root hub support 10953c81a348fa1d21dd042d9c9a9f91795f83fed66Manuel Lauss */ 11053c81a348fa1d21dd042d9c9a9f91795f83fed66Manuel Lauss .hub_status_data = ehci_hub_status_data, 11153c81a348fa1d21dd042d9c9a9f91795f83fed66Manuel Lauss .hub_control = ehci_hub_control, 11253c81a348fa1d21dd042d9c9a9f91795f83fed66Manuel Lauss .bus_suspend = ehci_bus_suspend, 11353c81a348fa1d21dd042d9c9a9f91795f83fed66Manuel Lauss .bus_resume = ehci_bus_resume, 11453c81a348fa1d21dd042d9c9a9f91795f83fed66Manuel Lauss .relinquish_port = ehci_relinquish_port, 11553c81a348fa1d21dd042d9c9a9f91795f83fed66Manuel Lauss .port_handed_over = ehci_port_handed_over, 116914b701280a76f96890ad63eb0fa99bf204b961cAlan Stern 117914b701280a76f96890ad63eb0fa99bf204b961cAlan Stern .clear_tt_buffer_complete = ehci_clear_tt_buffer_complete, 11853c81a348fa1d21dd042d9c9a9f91795f83fed66Manuel Lauss}; 11953c81a348fa1d21dd042d9c9a9f91795f83fed66Manuel Lauss 12053c81a348fa1d21dd042d9c9a9f91795f83fed66Manuel Laussstatic int ehci_hcd_au1xxx_drv_probe(struct platform_device *pdev) 12176fa9a240de4294a097235c9ddd470c21eb3449eJordan Crouse{ 12276fa9a240de4294a097235c9ddd470c21eb3449eJordan Crouse struct usb_hcd *hcd; 12376fa9a240de4294a097235c9ddd470c21eb3449eJordan Crouse struct ehci_hcd *ehci; 12453c81a348fa1d21dd042d9c9a9f91795f83fed66Manuel Lauss int ret; 12576fa9a240de4294a097235c9ddd470c21eb3449eJordan Crouse 12653c81a348fa1d21dd042d9c9a9f91795f83fed66Manuel Lauss if (usb_disabled()) 12753c81a348fa1d21dd042d9c9a9f91795f83fed66Manuel Lauss return -ENODEV; 12876fa9a240de4294a097235c9ddd470c21eb3449eJordan Crouse 12953c81a348fa1d21dd042d9c9a9f91795f83fed66Manuel Lauss#if defined(CONFIG_SOC_AU1200) && defined(CONFIG_DMA_COHERENT) 13076fa9a240de4294a097235c9ddd470c21eb3449eJordan Crouse /* Au1200 AB USB does not support coherent memory */ 13176fa9a240de4294a097235c9ddd470c21eb3449eJordan Crouse if (!(read_c0_prid() & 0xff)) { 13253c81a348fa1d21dd042d9c9a9f91795f83fed66Manuel Lauss printk(KERN_INFO "%s: this is chip revision AB!\n", pdev->name); 13353c81a348fa1d21dd042d9c9a9f91795f83fed66Manuel Lauss printk(KERN_INFO "%s: update your board or re-configure" 13453c81a348fa1d21dd042d9c9a9f91795f83fed66Manuel Lauss " the kernel\n", pdev->name); 13576fa9a240de4294a097235c9ddd470c21eb3449eJordan Crouse return -ENODEV; 13676fa9a240de4294a097235c9ddd470c21eb3449eJordan Crouse } 13776fa9a240de4294a097235c9ddd470c21eb3449eJordan Crouse#endif 13876fa9a240de4294a097235c9ddd470c21eb3449eJordan Crouse 13953c81a348fa1d21dd042d9c9a9f91795f83fed66Manuel Lauss if (pdev->resource[1].flags != IORESOURCE_IRQ) { 14076fa9a240de4294a097235c9ddd470c21eb3449eJordan Crouse pr_debug("resource[1] is not IORESOURCE_IRQ"); 14153c81a348fa1d21dd042d9c9a9f91795f83fed66Manuel Lauss return -ENOMEM; 14276fa9a240de4294a097235c9ddd470c21eb3449eJordan Crouse } 14353c81a348fa1d21dd042d9c9a9f91795f83fed66Manuel Lauss hcd = usb_create_hcd(&ehci_au1xxx_hc_driver, &pdev->dev, "Au1xxx"); 14476fa9a240de4294a097235c9ddd470c21eb3449eJordan Crouse if (!hcd) 14576fa9a240de4294a097235c9ddd470c21eb3449eJordan Crouse return -ENOMEM; 14653c81a348fa1d21dd042d9c9a9f91795f83fed66Manuel Lauss 14753c81a348fa1d21dd042d9c9a9f91795f83fed66Manuel Lauss hcd->rsrc_start = pdev->resource[0].start; 14853c81a348fa1d21dd042d9c9a9f91795f83fed66Manuel Lauss hcd->rsrc_len = pdev->resource[0].end - pdev->resource[0].start + 1; 14976fa9a240de4294a097235c9ddd470c21eb3449eJordan Crouse 15076fa9a240de4294a097235c9ddd470c21eb3449eJordan Crouse if (!request_mem_region(hcd->rsrc_start, hcd->rsrc_len, hcd_name)) { 15176fa9a240de4294a097235c9ddd470c21eb3449eJordan Crouse pr_debug("request_mem_region failed"); 15253c81a348fa1d21dd042d9c9a9f91795f83fed66Manuel Lauss ret = -EBUSY; 15376fa9a240de4294a097235c9ddd470c21eb3449eJordan Crouse goto err1; 15476fa9a240de4294a097235c9ddd470c21eb3449eJordan Crouse } 15576fa9a240de4294a097235c9ddd470c21eb3449eJordan Crouse 15676fa9a240de4294a097235c9ddd470c21eb3449eJordan Crouse hcd->regs = ioremap(hcd->rsrc_start, hcd->rsrc_len); 15776fa9a240de4294a097235c9ddd470c21eb3449eJordan Crouse if (!hcd->regs) { 15876fa9a240de4294a097235c9ddd470c21eb3449eJordan Crouse pr_debug("ioremap failed"); 15953c81a348fa1d21dd042d9c9a9f91795f83fed66Manuel Lauss ret = -ENOMEM; 16076fa9a240de4294a097235c9ddd470c21eb3449eJordan Crouse goto err2; 16176fa9a240de4294a097235c9ddd470c21eb3449eJordan Crouse } 16276fa9a240de4294a097235c9ddd470c21eb3449eJordan Crouse 16353c81a348fa1d21dd042d9c9a9f91795f83fed66Manuel Lauss au1xxx_start_ehc(); 16453c81a348fa1d21dd042d9c9a9f91795f83fed66Manuel Lauss 16576fa9a240de4294a097235c9ddd470c21eb3449eJordan Crouse ehci = hcd_to_ehci(hcd); 16676fa9a240de4294a097235c9ddd470c21eb3449eJordan Crouse ehci->caps = hcd->regs; 16776fa9a240de4294a097235c9ddd470c21eb3449eJordan Crouse ehci->regs = hcd->regs + HC_LENGTH(readl(&ehci->caps->hc_capbase)); 16876fa9a240de4294a097235c9ddd470c21eb3449eJordan Crouse /* cache this readonly data; minimize chip reads */ 16976fa9a240de4294a097235c9ddd470c21eb3449eJordan Crouse ehci->hcs_params = readl(&ehci->caps->hcs_params); 17076fa9a240de4294a097235c9ddd470c21eb3449eJordan Crouse 17153c81a348fa1d21dd042d9c9a9f91795f83fed66Manuel Lauss ret = usb_add_hcd(hcd, pdev->resource[1].start, 17253c81a348fa1d21dd042d9c9a9f91795f83fed66Manuel Lauss IRQF_DISABLED | IRQF_SHARED); 17353c81a348fa1d21dd042d9c9a9f91795f83fed66Manuel Lauss if (ret == 0) { 17453c81a348fa1d21dd042d9c9a9f91795f83fed66Manuel Lauss platform_set_drvdata(pdev, hcd); 17553c81a348fa1d21dd042d9c9a9f91795f83fed66Manuel Lauss return ret; 17653c81a348fa1d21dd042d9c9a9f91795f83fed66Manuel Lauss } 17776fa9a240de4294a097235c9ddd470c21eb3449eJordan Crouse 17853c81a348fa1d21dd042d9c9a9f91795f83fed66Manuel Lauss au1xxx_stop_ehc(); 17976fa9a240de4294a097235c9ddd470c21eb3449eJordan Crouse iounmap(hcd->regs); 18076fa9a240de4294a097235c9ddd470c21eb3449eJordan Crouseerr2: 18176fa9a240de4294a097235c9ddd470c21eb3449eJordan Crouse release_mem_region(hcd->rsrc_start, hcd->rsrc_len); 18276fa9a240de4294a097235c9ddd470c21eb3449eJordan Crouseerr1: 18376fa9a240de4294a097235c9ddd470c21eb3449eJordan Crouse usb_put_hcd(hcd); 18453c81a348fa1d21dd042d9c9a9f91795f83fed66Manuel Lauss return ret; 18576fa9a240de4294a097235c9ddd470c21eb3449eJordan Crouse} 18676fa9a240de4294a097235c9ddd470c21eb3449eJordan Crouse 18753c81a348fa1d21dd042d9c9a9f91795f83fed66Manuel Laussstatic int ehci_hcd_au1xxx_drv_remove(struct platform_device *pdev) 18876fa9a240de4294a097235c9ddd470c21eb3449eJordan Crouse{ 18953c81a348fa1d21dd042d9c9a9f91795f83fed66Manuel Lauss struct usb_hcd *hcd = platform_get_drvdata(pdev); 19053c81a348fa1d21dd042d9c9a9f91795f83fed66Manuel Lauss 19176fa9a240de4294a097235c9ddd470c21eb3449eJordan Crouse usb_remove_hcd(hcd); 19276fa9a240de4294a097235c9ddd470c21eb3449eJordan Crouse iounmap(hcd->regs); 19376fa9a240de4294a097235c9ddd470c21eb3449eJordan Crouse release_mem_region(hcd->rsrc_start, hcd->rsrc_len); 19476fa9a240de4294a097235c9ddd470c21eb3449eJordan Crouse usb_put_hcd(hcd); 19553c81a348fa1d21dd042d9c9a9f91795f83fed66Manuel Lauss au1xxx_stop_ehc(); 19653c81a348fa1d21dd042d9c9a9f91795f83fed66Manuel Lauss platform_set_drvdata(pdev, NULL); 19776fa9a240de4294a097235c9ddd470c21eb3449eJordan Crouse 19876fa9a240de4294a097235c9ddd470c21eb3449eJordan Crouse return 0; 19976fa9a240de4294a097235c9ddd470c21eb3449eJordan Crouse} 20076fa9a240de4294a097235c9ddd470c21eb3449eJordan Crouse 20142bfc7b44f724fb5ce838fc2f552a3eb8cd768ecManuel Lauss#ifdef CONFIG_PM 202807fcb5e19877d339a4cc56f2c6ddaf3a147457aManuel Laussstatic int ehci_hcd_au1xxx_drv_suspend(struct device *dev) 20376fa9a240de4294a097235c9ddd470c21eb3449eJordan Crouse{ 204807fcb5e19877d339a4cc56f2c6ddaf3a147457aManuel Lauss struct usb_hcd *hcd = dev_get_drvdata(dev); 20542bfc7b44f724fb5ce838fc2f552a3eb8cd768ecManuel Lauss struct ehci_hcd *ehci = hcd_to_ehci(hcd); 20642bfc7b44f724fb5ce838fc2f552a3eb8cd768ecManuel Lauss unsigned long flags; 20742bfc7b44f724fb5ce838fc2f552a3eb8cd768ecManuel Lauss int rc; 20876fa9a240de4294a097235c9ddd470c21eb3449eJordan Crouse 20976fa9a240de4294a097235c9ddd470c21eb3449eJordan Crouse return 0; 21042bfc7b44f724fb5ce838fc2f552a3eb8cd768ecManuel Lauss rc = 0; 21142bfc7b44f724fb5ce838fc2f552a3eb8cd768ecManuel Lauss 21242bfc7b44f724fb5ce838fc2f552a3eb8cd768ecManuel Lauss if (time_before(jiffies, ehci->next_statechange)) 21342bfc7b44f724fb5ce838fc2f552a3eb8cd768ecManuel Lauss msleep(10); 21442bfc7b44f724fb5ce838fc2f552a3eb8cd768ecManuel Lauss 21542bfc7b44f724fb5ce838fc2f552a3eb8cd768ecManuel Lauss /* Root hub was already suspended. Disable irq emission and 21642bfc7b44f724fb5ce838fc2f552a3eb8cd768ecManuel Lauss * mark HW unaccessible, bail out if RH has been resumed. Use 21742bfc7b44f724fb5ce838fc2f552a3eb8cd768ecManuel Lauss * the spinlock to properly synchronize with possible pending 21842bfc7b44f724fb5ce838fc2f552a3eb8cd768ecManuel Lauss * RH suspend or resume activity. 21942bfc7b44f724fb5ce838fc2f552a3eb8cd768ecManuel Lauss * 22042bfc7b44f724fb5ce838fc2f552a3eb8cd768ecManuel Lauss * This is still racy as hcd->state is manipulated outside of 22142bfc7b44f724fb5ce838fc2f552a3eb8cd768ecManuel Lauss * any locks =P But that will be a different fix. 22242bfc7b44f724fb5ce838fc2f552a3eb8cd768ecManuel Lauss */ 22342bfc7b44f724fb5ce838fc2f552a3eb8cd768ecManuel Lauss spin_lock_irqsave(&ehci->lock, flags); 22442bfc7b44f724fb5ce838fc2f552a3eb8cd768ecManuel Lauss if (hcd->state != HC_STATE_SUSPENDED) { 22542bfc7b44f724fb5ce838fc2f552a3eb8cd768ecManuel Lauss rc = -EINVAL; 22642bfc7b44f724fb5ce838fc2f552a3eb8cd768ecManuel Lauss goto bail; 22742bfc7b44f724fb5ce838fc2f552a3eb8cd768ecManuel Lauss } 22842bfc7b44f724fb5ce838fc2f552a3eb8cd768ecManuel Lauss ehci_writel(ehci, 0, &ehci->regs->intr_enable); 22942bfc7b44f724fb5ce838fc2f552a3eb8cd768ecManuel Lauss (void)ehci_readl(ehci, &ehci->regs->intr_enable); 23042bfc7b44f724fb5ce838fc2f552a3eb8cd768ecManuel Lauss 23142bfc7b44f724fb5ce838fc2f552a3eb8cd768ecManuel Lauss clear_bit(HCD_FLAG_HW_ACCESSIBLE, &hcd->flags); 23242bfc7b44f724fb5ce838fc2f552a3eb8cd768ecManuel Lauss 23342bfc7b44f724fb5ce838fc2f552a3eb8cd768ecManuel Lauss au1xxx_stop_ehc(); 23442bfc7b44f724fb5ce838fc2f552a3eb8cd768ecManuel Lauss 23542bfc7b44f724fb5ce838fc2f552a3eb8cd768ecManuel Laussbail: 23642bfc7b44f724fb5ce838fc2f552a3eb8cd768ecManuel Lauss spin_unlock_irqrestore(&ehci->lock, flags); 23742bfc7b44f724fb5ce838fc2f552a3eb8cd768ecManuel Lauss 23842bfc7b44f724fb5ce838fc2f552a3eb8cd768ecManuel Lauss // could save FLADJ in case of Vaux power loss 23942bfc7b44f724fb5ce838fc2f552a3eb8cd768ecManuel Lauss // ... we'd only use it to handle clock skew 24042bfc7b44f724fb5ce838fc2f552a3eb8cd768ecManuel Lauss 24142bfc7b44f724fb5ce838fc2f552a3eb8cd768ecManuel Lauss return rc; 24276fa9a240de4294a097235c9ddd470c21eb3449eJordan Crouse} 24342bfc7b44f724fb5ce838fc2f552a3eb8cd768ecManuel Lauss 244807fcb5e19877d339a4cc56f2c6ddaf3a147457aManuel Laussstatic int ehci_hcd_au1xxx_drv_resume(struct device *dev) 24576fa9a240de4294a097235c9ddd470c21eb3449eJordan Crouse{ 246807fcb5e19877d339a4cc56f2c6ddaf3a147457aManuel Lauss struct usb_hcd *hcd = dev_get_drvdata(dev); 24742bfc7b44f724fb5ce838fc2f552a3eb8cd768ecManuel Lauss struct ehci_hcd *ehci = hcd_to_ehci(hcd); 24842bfc7b44f724fb5ce838fc2f552a3eb8cd768ecManuel Lauss 24942bfc7b44f724fb5ce838fc2f552a3eb8cd768ecManuel Lauss au1xxx_start_ehc(); 25042bfc7b44f724fb5ce838fc2f552a3eb8cd768ecManuel Lauss 25142bfc7b44f724fb5ce838fc2f552a3eb8cd768ecManuel Lauss // maybe restore FLADJ 25242bfc7b44f724fb5ce838fc2f552a3eb8cd768ecManuel Lauss 25342bfc7b44f724fb5ce838fc2f552a3eb8cd768ecManuel Lauss if (time_before(jiffies, ehci->next_statechange)) 25442bfc7b44f724fb5ce838fc2f552a3eb8cd768ecManuel Lauss msleep(100); 25542bfc7b44f724fb5ce838fc2f552a3eb8cd768ecManuel Lauss 25642bfc7b44f724fb5ce838fc2f552a3eb8cd768ecManuel Lauss /* Mark hardware accessible again as we are out of D3 state by now */ 25742bfc7b44f724fb5ce838fc2f552a3eb8cd768ecManuel Lauss set_bit(HCD_FLAG_HW_ACCESSIBLE, &hcd->flags); 25842bfc7b44f724fb5ce838fc2f552a3eb8cd768ecManuel Lauss 25942bfc7b44f724fb5ce838fc2f552a3eb8cd768ecManuel Lauss /* If CF is still set, we maintained PCI Vaux power. 26042bfc7b44f724fb5ce838fc2f552a3eb8cd768ecManuel Lauss * Just undo the effect of ehci_pci_suspend(). 26142bfc7b44f724fb5ce838fc2f552a3eb8cd768ecManuel Lauss */ 26242bfc7b44f724fb5ce838fc2f552a3eb8cd768ecManuel Lauss if (ehci_readl(ehci, &ehci->regs->configured_flag) == FLAG_CF) { 26342bfc7b44f724fb5ce838fc2f552a3eb8cd768ecManuel Lauss int mask = INTR_MASK; 26442bfc7b44f724fb5ce838fc2f552a3eb8cd768ecManuel Lauss 26542bfc7b44f724fb5ce838fc2f552a3eb8cd768ecManuel Lauss if (!hcd->self.root_hub->do_remote_wakeup) 26642bfc7b44f724fb5ce838fc2f552a3eb8cd768ecManuel Lauss mask &= ~STS_PCD; 26742bfc7b44f724fb5ce838fc2f552a3eb8cd768ecManuel Lauss ehci_writel(ehci, mask, &ehci->regs->intr_enable); 26842bfc7b44f724fb5ce838fc2f552a3eb8cd768ecManuel Lauss ehci_readl(ehci, &ehci->regs->intr_enable); 26942bfc7b44f724fb5ce838fc2f552a3eb8cd768ecManuel Lauss return 0; 27042bfc7b44f724fb5ce838fc2f552a3eb8cd768ecManuel Lauss } 27142bfc7b44f724fb5ce838fc2f552a3eb8cd768ecManuel Lauss 27242bfc7b44f724fb5ce838fc2f552a3eb8cd768ecManuel Lauss ehci_dbg(ehci, "lost power, restarting\n"); 27342bfc7b44f724fb5ce838fc2f552a3eb8cd768ecManuel Lauss usb_root_hub_lost_power(hcd->self.root_hub); 27442bfc7b44f724fb5ce838fc2f552a3eb8cd768ecManuel Lauss 27542bfc7b44f724fb5ce838fc2f552a3eb8cd768ecManuel Lauss /* Else reset, to cope with power loss or flush-to-storage 27642bfc7b44f724fb5ce838fc2f552a3eb8cd768ecManuel Lauss * style "resume" having let BIOS kick in during reboot. 27742bfc7b44f724fb5ce838fc2f552a3eb8cd768ecManuel Lauss */ 27842bfc7b44f724fb5ce838fc2f552a3eb8cd768ecManuel Lauss (void) ehci_halt(ehci); 27942bfc7b44f724fb5ce838fc2f552a3eb8cd768ecManuel Lauss (void) ehci_reset(ehci); 28042bfc7b44f724fb5ce838fc2f552a3eb8cd768ecManuel Lauss 28142bfc7b44f724fb5ce838fc2f552a3eb8cd768ecManuel Lauss /* emptying the schedule aborts any urbs */ 28242bfc7b44f724fb5ce838fc2f552a3eb8cd768ecManuel Lauss spin_lock_irq(&ehci->lock); 28342bfc7b44f724fb5ce838fc2f552a3eb8cd768ecManuel Lauss if (ehci->reclaim) 28442bfc7b44f724fb5ce838fc2f552a3eb8cd768ecManuel Lauss end_unlink_async(ehci); 28542bfc7b44f724fb5ce838fc2f552a3eb8cd768ecManuel Lauss ehci_work(ehci); 28642bfc7b44f724fb5ce838fc2f552a3eb8cd768ecManuel Lauss spin_unlock_irq(&ehci->lock); 28742bfc7b44f724fb5ce838fc2f552a3eb8cd768ecManuel Lauss 28842bfc7b44f724fb5ce838fc2f552a3eb8cd768ecManuel Lauss ehci_writel(ehci, ehci->command, &ehci->regs->command); 28942bfc7b44f724fb5ce838fc2f552a3eb8cd768ecManuel Lauss ehci_writel(ehci, FLAG_CF, &ehci->regs->configured_flag); 29042bfc7b44f724fb5ce838fc2f552a3eb8cd768ecManuel Lauss ehci_readl(ehci, &ehci->regs->command); /* unblock posted writes */ 29142bfc7b44f724fb5ce838fc2f552a3eb8cd768ecManuel Lauss 29242bfc7b44f724fb5ce838fc2f552a3eb8cd768ecManuel Lauss /* here we "know" root ports should always stay powered */ 29342bfc7b44f724fb5ce838fc2f552a3eb8cd768ecManuel Lauss ehci_port_power(ehci, 1); 29442bfc7b44f724fb5ce838fc2f552a3eb8cd768ecManuel Lauss 29542bfc7b44f724fb5ce838fc2f552a3eb8cd768ecManuel Lauss hcd->state = HC_STATE_SUSPENDED; 29676fa9a240de4294a097235c9ddd470c21eb3449eJordan Crouse 29776fa9a240de4294a097235c9ddd470c21eb3449eJordan Crouse return 0; 29876fa9a240de4294a097235c9ddd470c21eb3449eJordan Crouse} 29942bfc7b44f724fb5ce838fc2f552a3eb8cd768ecManuel Lauss 300807fcb5e19877d339a4cc56f2c6ddaf3a147457aManuel Laussstatic struct dev_pm_ops au1xxx_ehci_pmops = { 301807fcb5e19877d339a4cc56f2c6ddaf3a147457aManuel Lauss .suspend = ehci_hcd_au1xxx_drv_suspend, 302807fcb5e19877d339a4cc56f2c6ddaf3a147457aManuel Lauss .resume = ehci_hcd_au1xxx_drv_resume, 303807fcb5e19877d339a4cc56f2c6ddaf3a147457aManuel Lauss}; 304807fcb5e19877d339a4cc56f2c6ddaf3a147457aManuel Lauss 305807fcb5e19877d339a4cc56f2c6ddaf3a147457aManuel Lauss#define AU1XXX_EHCI_PMOPS &au1xxx_ehci_pmops 306807fcb5e19877d339a4cc56f2c6ddaf3a147457aManuel Lauss 30742bfc7b44f724fb5ce838fc2f552a3eb8cd768ecManuel Lauss#else 308807fcb5e19877d339a4cc56f2c6ddaf3a147457aManuel Lauss#define AU1XXX_EHCI_PMOPS NULL 30942bfc7b44f724fb5ce838fc2f552a3eb8cd768ecManuel Lauss#endif 31053c81a348fa1d21dd042d9c9a9f91795f83fed66Manuel Lauss 311d14feb5ee4a46218f92b21ed52338b64130a151bDaniel Mackstatic struct platform_driver ehci_hcd_au1xxx_driver = { 31253c81a348fa1d21dd042d9c9a9f91795f83fed66Manuel Lauss .probe = ehci_hcd_au1xxx_drv_probe, 31353c81a348fa1d21dd042d9c9a9f91795f83fed66Manuel Lauss .remove = ehci_hcd_au1xxx_drv_remove, 31453c81a348fa1d21dd042d9c9a9f91795f83fed66Manuel Lauss .shutdown = usb_hcd_platform_shutdown, 315d14feb5ee4a46218f92b21ed52338b64130a151bDaniel Mack .driver = { 31653c81a348fa1d21dd042d9c9a9f91795f83fed66Manuel Lauss .name = "au1xxx-ehci", 31753c81a348fa1d21dd042d9c9a9f91795f83fed66Manuel Lauss .owner = THIS_MODULE, 318807fcb5e19877d339a4cc56f2c6ddaf3a147457aManuel Lauss .pm = AU1XXX_EHCI_PMOPS, 319d14feb5ee4a46218f92b21ed52338b64130a151bDaniel Mack } 32076fa9a240de4294a097235c9ddd470c21eb3449eJordan Crouse}; 32153c81a348fa1d21dd042d9c9a9f91795f83fed66Manuel Lauss 32253c81a348fa1d21dd042d9c9a9f91795f83fed66Manuel LaussMODULE_ALIAS("platform:au1xxx-ehci"); 323