|
@@ -13,13 +13,24 @@
|
|
|
*/
|
|
|
|
|
|
#include <linux/clk.h>
|
|
|
+#include <linux/dma-mapping.h>
|
|
|
+#include <linux/io.h>
|
|
|
+#include <linux/kernel.h>
|
|
|
+#include <linux/module.h>
|
|
|
#include <linux/of.h>
|
|
|
-#include <linux/platform_device.h>
|
|
|
#include <linux/of_gpio.h>
|
|
|
+#include <linux/platform_device.h>
|
|
|
#include <linux/platform_data/usb-ehci-s5p.h>
|
|
|
#include <linux/usb/phy.h>
|
|
|
#include <linux/usb/samsung_usb_phy.h>
|
|
|
#include <plat/usb-phy.h>
|
|
|
+#include <linux/usb.h>
|
|
|
+#include <linux/usb/hcd.h>
|
|
|
+#include <linux/usb/otg.h>
|
|
|
+
|
|
|
+#include "ehci.h"
|
|
|
+
|
|
|
+#define DRIVER_DESC "EHCI s5p driver"
|
|
|
|
|
|
#define EHCI_INSNREG00(base) (base + 0x90)
|
|
|
#define EHCI_INSNREG00_ENA_INCR16 (0x1 << 25)
|
|
@@ -30,65 +41,17 @@
|
|
|
(EHCI_INSNREG00_ENA_INCR16 | EHCI_INSNREG00_ENA_INCR8 | \
|
|
|
EHCI_INSNREG00_ENA_INCR4 | EHCI_INSNREG00_ENA_INCRX_ALIGN)
|
|
|
|
|
|
+static const char hcd_name[] = "ehci-s5p";
|
|
|
+static struct hc_driver __read_mostly s5p_ehci_hc_driver;
|
|
|
+
|
|
|
struct s5p_ehci_hcd {
|
|
|
- struct device *dev;
|
|
|
- struct usb_hcd *hcd;
|
|
|
struct clk *clk;
|
|
|
struct usb_phy *phy;
|
|
|
struct usb_otg *otg;
|
|
|
struct s5p_ehci_platdata *pdata;
|
|
|
};
|
|
|
|
|
|
-static const struct hc_driver s5p_ehci_hc_driver = {
|
|
|
- .description = hcd_name,
|
|
|
- .product_desc = "S5P EHCI Host Controller",
|
|
|
- .hcd_priv_size = sizeof(struct ehci_hcd),
|
|
|
-
|
|
|
- .irq = ehci_irq,
|
|
|
- .flags = HCD_MEMORY | HCD_USB2,
|
|
|
-
|
|
|
- .reset = ehci_setup,
|
|
|
- .start = ehci_run,
|
|
|
- .stop = ehci_stop,
|
|
|
- .shutdown = ehci_shutdown,
|
|
|
-
|
|
|
- .get_frame_number = ehci_get_frame,
|
|
|
-
|
|
|
- .urb_enqueue = ehci_urb_enqueue,
|
|
|
- .urb_dequeue = ehci_urb_dequeue,
|
|
|
- .endpoint_disable = ehci_endpoint_disable,
|
|
|
- .endpoint_reset = ehci_endpoint_reset,
|
|
|
-
|
|
|
- .hub_status_data = ehci_hub_status_data,
|
|
|
- .hub_control = ehci_hub_control,
|
|
|
- .bus_suspend = ehci_bus_suspend,
|
|
|
- .bus_resume = ehci_bus_resume,
|
|
|
-
|
|
|
- .relinquish_port = ehci_relinquish_port,
|
|
|
- .port_handed_over = ehci_port_handed_over,
|
|
|
-
|
|
|
- .clear_tt_buffer_complete = ehci_clear_tt_buffer_complete,
|
|
|
-};
|
|
|
-
|
|
|
-static void s5p_ehci_phy_enable(struct s5p_ehci_hcd *s5p_ehci)
|
|
|
-{
|
|
|
- struct platform_device *pdev = to_platform_device(s5p_ehci->dev);
|
|
|
-
|
|
|
- if (s5p_ehci->phy)
|
|
|
- usb_phy_init(s5p_ehci->phy);
|
|
|
- else if (s5p_ehci->pdata->phy_init)
|
|
|
- s5p_ehci->pdata->phy_init(pdev, USB_PHY_TYPE_HOST);
|
|
|
-}
|
|
|
-
|
|
|
-static void s5p_ehci_phy_disable(struct s5p_ehci_hcd *s5p_ehci)
|
|
|
-{
|
|
|
- struct platform_device *pdev = to_platform_device(s5p_ehci->dev);
|
|
|
-
|
|
|
- if (s5p_ehci->phy)
|
|
|
- usb_phy_shutdown(s5p_ehci->phy);
|
|
|
- else if (s5p_ehci->pdata->phy_exit)
|
|
|
- s5p_ehci->pdata->phy_exit(pdev, USB_PHY_TYPE_HOST);
|
|
|
-}
|
|
|
+#define to_s5p_ehci(hcd) (struct s5p_ehci_hcd *)(hcd_to_ehci(hcd)->priv)
|
|
|
|
|
|
static void s5p_setup_vbus_gpio(struct platform_device *pdev)
|
|
|
{
|
|
@@ -134,11 +97,13 @@ static int s5p_ehci_probe(struct platform_device *pdev)
|
|
|
|
|
|
s5p_setup_vbus_gpio(pdev);
|
|
|
|
|
|
- s5p_ehci = devm_kzalloc(&pdev->dev, sizeof(struct s5p_ehci_hcd),
|
|
|
- GFP_KERNEL);
|
|
|
- if (!s5p_ehci)
|
|
|
+ hcd = usb_create_hcd(&s5p_ehci_hc_driver,
|
|
|
+ &pdev->dev, dev_name(&pdev->dev));
|
|
|
+ if (!hcd) {
|
|
|
+ dev_err(&pdev->dev, "Unable to create HCD\n");
|
|
|
return -ENOMEM;
|
|
|
-
|
|
|
+ }
|
|
|
+ s5p_ehci = to_s5p_ehci(hcd);
|
|
|
phy = devm_usb_get_phy(&pdev->dev, USB_PHY_TYPE_USB2);
|
|
|
if (IS_ERR(phy)) {
|
|
|
/* Fallback to pdata */
|
|
@@ -153,16 +118,6 @@ static int s5p_ehci_probe(struct platform_device *pdev)
|
|
|
s5p_ehci->otg = phy->otg;
|
|
|
}
|
|
|
|
|
|
- s5p_ehci->dev = &pdev->dev;
|
|
|
-
|
|
|
- hcd = usb_create_hcd(&s5p_ehci_hc_driver, &pdev->dev,
|
|
|
- dev_name(&pdev->dev));
|
|
|
- if (!hcd) {
|
|
|
- dev_err(&pdev->dev, "Unable to create HCD\n");
|
|
|
- return -ENOMEM;
|
|
|
- }
|
|
|
-
|
|
|
- s5p_ehci->hcd = hcd;
|
|
|
s5p_ehci->clk = devm_clk_get(&pdev->dev, "usbhost");
|
|
|
|
|
|
if (IS_ERR(s5p_ehci->clk)) {
|
|
@@ -199,9 +154,12 @@ static int s5p_ehci_probe(struct platform_device *pdev)
|
|
|
}
|
|
|
|
|
|
if (s5p_ehci->otg)
|
|
|
- s5p_ehci->otg->set_host(s5p_ehci->otg, &s5p_ehci->hcd->self);
|
|
|
+ s5p_ehci->otg->set_host(s5p_ehci->otg, &hcd->self);
|
|
|
|
|
|
- s5p_ehci_phy_enable(s5p_ehci);
|
|
|
+ if (s5p_ehci->phy)
|
|
|
+ usb_phy_init(s5p_ehci->phy);
|
|
|
+ else if (s5p_ehci->pdata->phy_init)
|
|
|
+ s5p_ehci->pdata->phy_init(pdev, USB_PHY_TYPE_HOST);
|
|
|
|
|
|
ehci = hcd_to_ehci(hcd);
|
|
|
ehci->caps = hcd->regs;
|
|
@@ -220,7 +178,10 @@ static int s5p_ehci_probe(struct platform_device *pdev)
|
|
|
return 0;
|
|
|
|
|
|
fail_add_hcd:
|
|
|
- s5p_ehci_phy_disable(s5p_ehci);
|
|
|
+ if (s5p_ehci->phy)
|
|
|
+ usb_phy_shutdown(s5p_ehci->phy);
|
|
|
+ else if (s5p_ehci->pdata->phy_exit)
|
|
|
+ s5p_ehci->pdata->phy_exit(pdev, USB_PHY_TYPE_HOST);
|
|
|
fail_io:
|
|
|
clk_disable_unprepare(s5p_ehci->clk);
|
|
|
fail_clk:
|
|
@@ -230,15 +191,18 @@ fail_clk:
|
|
|
|
|
|
static int s5p_ehci_remove(struct platform_device *pdev)
|
|
|
{
|
|
|
- struct s5p_ehci_hcd *s5p_ehci = platform_get_drvdata(pdev);
|
|
|
- struct usb_hcd *hcd = s5p_ehci->hcd;
|
|
|
+ struct usb_hcd *hcd = platform_get_drvdata(pdev);
|
|
|
+ struct s5p_ehci_hcd *s5p_ehci = to_s5p_ehci(hcd);
|
|
|
|
|
|
usb_remove_hcd(hcd);
|
|
|
|
|
|
if (s5p_ehci->otg)
|
|
|
- s5p_ehci->otg->set_host(s5p_ehci->otg, &s5p_ehci->hcd->self);
|
|
|
+ s5p_ehci->otg->set_host(s5p_ehci->otg, &hcd->self);
|
|
|
|
|
|
- s5p_ehci_phy_disable(s5p_ehci);
|
|
|
+ if (s5p_ehci->phy)
|
|
|
+ usb_phy_shutdown(s5p_ehci->phy);
|
|
|
+ else if (s5p_ehci->pdata->phy_exit)
|
|
|
+ s5p_ehci->pdata->phy_exit(pdev, USB_PHY_TYPE_HOST);
|
|
|
|
|
|
clk_disable_unprepare(s5p_ehci->clk);
|
|
|
|
|
@@ -249,8 +213,7 @@ static int s5p_ehci_remove(struct platform_device *pdev)
|
|
|
|
|
|
static void s5p_ehci_shutdown(struct platform_device *pdev)
|
|
|
{
|
|
|
- struct s5p_ehci_hcd *s5p_ehci = platform_get_drvdata(pdev);
|
|
|
- struct usb_hcd *hcd = s5p_ehci->hcd;
|
|
|
+ struct usb_hcd *hcd = platform_get_drvdata(pdev);
|
|
|
|
|
|
if (hcd->driver->shutdown)
|
|
|
hcd->driver->shutdown(hcd);
|
|
@@ -259,17 +222,22 @@ static void s5p_ehci_shutdown(struct platform_device *pdev)
|
|
|
#ifdef CONFIG_PM
|
|
|
static int s5p_ehci_suspend(struct device *dev)
|
|
|
{
|
|
|
- struct s5p_ehci_hcd *s5p_ehci = dev_get_drvdata(dev);
|
|
|
- struct usb_hcd *hcd = s5p_ehci->hcd;
|
|
|
+ struct usb_hcd *hcd = dev_get_drvdata(dev);
|
|
|
+ struct s5p_ehci_hcd *s5p_ehci = to_s5p_ehci(hcd);
|
|
|
+ struct platform_device *pdev = to_platform_device(dev);
|
|
|
+
|
|
|
bool do_wakeup = device_may_wakeup(dev);
|
|
|
int rc;
|
|
|
|
|
|
rc = ehci_suspend(hcd, do_wakeup);
|
|
|
|
|
|
if (s5p_ehci->otg)
|
|
|
- s5p_ehci->otg->set_host(s5p_ehci->otg, &s5p_ehci->hcd->self);
|
|
|
+ s5p_ehci->otg->set_host(s5p_ehci->otg, &hcd->self);
|
|
|
|
|
|
- s5p_ehci_phy_disable(s5p_ehci);
|
|
|
+ if (s5p_ehci->phy)
|
|
|
+ usb_phy_shutdown(s5p_ehci->phy);
|
|
|
+ else if (s5p_ehci->pdata->phy_exit)
|
|
|
+ s5p_ehci->pdata->phy_exit(pdev, USB_PHY_TYPE_HOST);
|
|
|
|
|
|
clk_disable_unprepare(s5p_ehci->clk);
|
|
|
|
|
@@ -278,15 +246,19 @@ static int s5p_ehci_suspend(struct device *dev)
|
|
|
|
|
|
static int s5p_ehci_resume(struct device *dev)
|
|
|
{
|
|
|
- struct s5p_ehci_hcd *s5p_ehci = dev_get_drvdata(dev);
|
|
|
- struct usb_hcd *hcd = s5p_ehci->hcd;
|
|
|
+ struct usb_hcd *hcd = dev_get_drvdata(dev);
|
|
|
+ struct s5p_ehci_hcd *s5p_ehci = to_s5p_ehci(hcd);
|
|
|
+ struct platform_device *pdev = to_platform_device(dev);
|
|
|
|
|
|
clk_prepare_enable(s5p_ehci->clk);
|
|
|
|
|
|
if (s5p_ehci->otg)
|
|
|
- s5p_ehci->otg->set_host(s5p_ehci->otg, &s5p_ehci->hcd->self);
|
|
|
+ s5p_ehci->otg->set_host(s5p_ehci->otg, &hcd->self);
|
|
|
|
|
|
- s5p_ehci_phy_enable(s5p_ehci);
|
|
|
+ if (s5p_ehci->phy)
|
|
|
+ usb_phy_init(s5p_ehci->phy);
|
|
|
+ else if (s5p_ehci->pdata->phy_init)
|
|
|
+ s5p_ehci->pdata->phy_init(pdev, USB_PHY_TYPE_HOST);
|
|
|
|
|
|
/* DMA burst Enable */
|
|
|
writel(EHCI_INSNREG00_ENABLE_DMA_BURST, EHCI_INSNREG00(hcd->regs));
|
|
@@ -323,5 +295,29 @@ static struct platform_driver s5p_ehci_driver = {
|
|
|
.of_match_table = of_match_ptr(exynos_ehci_match),
|
|
|
}
|
|
|
};
|
|
|
+static const struct ehci_driver_overrides s5p_overrides __initdata = {
|
|
|
+ .extra_priv_size = sizeof(struct s5p_ehci_hcd),
|
|
|
+};
|
|
|
+
|
|
|
+static int __init ehci_s5p_init(void)
|
|
|
+{
|
|
|
+ if (usb_disabled())
|
|
|
+ return -ENODEV;
|
|
|
+
|
|
|
+ pr_info("%s: " DRIVER_DESC "\n", hcd_name);
|
|
|
+ ehci_init_driver(&s5p_ehci_hc_driver, &s5p_overrides);
|
|
|
+ return platform_driver_register(&s5p_ehci_driver);
|
|
|
+}
|
|
|
+module_init(ehci_s5p_init);
|
|
|
+
|
|
|
+static void __exit ehci_s5p_cleanup(void)
|
|
|
+{
|
|
|
+ platform_driver_unregister(&s5p_ehci_driver);
|
|
|
+}
|
|
|
+module_exit(ehci_s5p_cleanup);
|
|
|
|
|
|
+MODULE_DESCRIPTION(DRIVER_DESC);
|
|
|
MODULE_ALIAS("platform:s5p-ehci");
|
|
|
+MODULE_AUTHOR("Jingoo Han");
|
|
|
+MODULE_AUTHOR("Joonyoung Shim");
|
|
|
+MODULE_LICENSE("GPL v2");
|