|
@@ -19,10 +19,19 @@
|
|
|
* or implied.
|
|
|
*/
|
|
|
#include <linux/clk.h>
|
|
|
-#include <linux/platform_device.h>
|
|
|
+#include <linux/dma-mapping.h>
|
|
|
+#include <linux/io.h>
|
|
|
#include <linux/i2c.h>
|
|
|
+#include <linux/kernel.h>
|
|
|
+#include <linux/module.h>
|
|
|
#include <linux/of.h>
|
|
|
+#include <linux/platform_device.h>
|
|
|
#include <linux/usb/isp1301.h>
|
|
|
+#include <linux/usb.h>
|
|
|
+#include <linux/usb/hcd.h>
|
|
|
+
|
|
|
+#include "ohci.h"
|
|
|
+
|
|
|
|
|
|
#include <mach/hardware.h>
|
|
|
#include <asm/mach-types.h>
|
|
@@ -57,6 +66,11 @@
|
|
|
#define start_int_umask(irq)
|
|
|
#endif
|
|
|
|
|
|
+#define DRIVER_DESC "OHCI NXP driver"
|
|
|
+
|
|
|
+static const char hcd_name[] = "ohci-nxp";
|
|
|
+static struct hc_driver __read_mostly ohci_nxp_hc_driver;
|
|
|
+
|
|
|
static struct i2c_client *isp1301_i2c_client;
|
|
|
|
|
|
extern int usb_disabled(void);
|
|
@@ -132,14 +146,14 @@ static inline void isp1301_vbus_off(void)
|
|
|
OTG1_VBUS_DRV);
|
|
|
}
|
|
|
|
|
|
-static void nxp_start_hc(void)
|
|
|
+static void ohci_nxp_start_hc(void)
|
|
|
{
|
|
|
unsigned long tmp = __raw_readl(USB_OTG_STAT_CONTROL) | HOST_EN;
|
|
|
__raw_writel(tmp, USB_OTG_STAT_CONTROL);
|
|
|
isp1301_vbus_on();
|
|
|
}
|
|
|
|
|
|
-static void nxp_stop_hc(void)
|
|
|
+static void ohci_nxp_stop_hc(void)
|
|
|
{
|
|
|
unsigned long tmp;
|
|
|
isp1301_vbus_off();
|
|
@@ -147,68 +161,9 @@ static void nxp_stop_hc(void)
|
|
|
__raw_writel(tmp, USB_OTG_STAT_CONTROL);
|
|
|
}
|
|
|
|
|
|
-static int ohci_nxp_start(struct usb_hcd *hcd)
|
|
|
-{
|
|
|
- struct ohci_hcd *ohci = hcd_to_ohci(hcd);
|
|
|
- int ret;
|
|
|
-
|
|
|
- if ((ret = ohci_init(ohci)) < 0)
|
|
|
- return ret;
|
|
|
-
|
|
|
- if ((ret = ohci_run(ohci)) < 0) {
|
|
|
- dev_err(hcd->self.controller, "can't start\n");
|
|
|
- ohci_stop(hcd);
|
|
|
- return ret;
|
|
|
- }
|
|
|
- return 0;
|
|
|
-}
|
|
|
-
|
|
|
-static const struct hc_driver ohci_nxp_hc_driver = {
|
|
|
- .description = hcd_name,
|
|
|
- .product_desc = "nxp OHCI",
|
|
|
-
|
|
|
- /*
|
|
|
- * generic hardware linkage
|
|
|
- */
|
|
|
- .irq = ohci_irq,
|
|
|
- .flags = HCD_USB11 | HCD_MEMORY,
|
|
|
-
|
|
|
- .hcd_priv_size = sizeof(struct ohci_hcd),
|
|
|
- /*
|
|
|
- * basic lifecycle operations
|
|
|
- */
|
|
|
- .start = ohci_nxp_start,
|
|
|
- .stop = ohci_stop,
|
|
|
- .shutdown = ohci_shutdown,
|
|
|
-
|
|
|
- /*
|
|
|
- * managing i/o requests and associated device resources
|
|
|
- */
|
|
|
- .urb_enqueue = ohci_urb_enqueue,
|
|
|
- .urb_dequeue = ohci_urb_dequeue,
|
|
|
- .endpoint_disable = ohci_endpoint_disable,
|
|
|
-
|
|
|
- /*
|
|
|
- * scheduling support
|
|
|
- */
|
|
|
- .get_frame_number = ohci_get_frame,
|
|
|
-
|
|
|
- /*
|
|
|
- * root hub support
|
|
|
- */
|
|
|
- .hub_status_data = ohci_hub_status_data,
|
|
|
- .hub_control = ohci_hub_control,
|
|
|
-#ifdef CONFIG_PM
|
|
|
- .bus_suspend = ohci_bus_suspend,
|
|
|
- .bus_resume = ohci_bus_resume,
|
|
|
-#endif
|
|
|
- .start_port_reset = ohci_start_port_reset,
|
|
|
-};
|
|
|
-
|
|
|
-static int usb_hcd_nxp_probe(struct platform_device *pdev)
|
|
|
+static int ohci_hcd_nxp_probe(struct platform_device *pdev)
|
|
|
{
|
|
|
struct usb_hcd *hcd = 0;
|
|
|
- struct ohci_hcd *ohci;
|
|
|
const struct hc_driver *driver = &ohci_nxp_hc_driver;
|
|
|
struct resource *res;
|
|
|
int ret = 0, irq;
|
|
@@ -313,17 +268,15 @@ static int usb_hcd_nxp_probe(struct platform_device *pdev)
|
|
|
goto fail_resource;
|
|
|
}
|
|
|
|
|
|
- nxp_start_hc();
|
|
|
+ ohci_nxp_start_hc();
|
|
|
platform_set_drvdata(pdev, hcd);
|
|
|
- ohci = hcd_to_ohci(hcd);
|
|
|
- ohci_hcd_init(ohci);
|
|
|
|
|
|
dev_info(&pdev->dev, "at 0x%p, irq %d\n", hcd->regs, hcd->irq);
|
|
|
ret = usb_add_hcd(hcd, irq, 0);
|
|
|
if (ret == 0)
|
|
|
return ret;
|
|
|
|
|
|
- nxp_stop_hc();
|
|
|
+ ohci_nxp_stop_hc();
|
|
|
fail_resource:
|
|
|
usb_put_hcd(hcd);
|
|
|
fail_hcd:
|
|
@@ -345,12 +298,12 @@ fail_disable:
|
|
|
return ret;
|
|
|
}
|
|
|
|
|
|
-static int usb_hcd_nxp_remove(struct platform_device *pdev)
|
|
|
+static int ohci_hcd_nxp_remove(struct platform_device *pdev)
|
|
|
{
|
|
|
struct usb_hcd *hcd = platform_get_drvdata(pdev);
|
|
|
|
|
|
usb_remove_hcd(hcd);
|
|
|
- nxp_stop_hc();
|
|
|
+ ohci_nxp_stop_hc();
|
|
|
usb_put_hcd(hcd);
|
|
|
clk_disable(usb_pll_clk);
|
|
|
clk_put(usb_pll_clk);
|
|
@@ -366,20 +319,40 @@ static int usb_hcd_nxp_remove(struct platform_device *pdev)
|
|
|
MODULE_ALIAS("platform:usb-ohci");
|
|
|
|
|
|
#ifdef CONFIG_OF
|
|
|
-static const struct of_device_id usb_hcd_nxp_match[] = {
|
|
|
+static const struct of_device_id ohci_hcd_nxp_match[] = {
|
|
|
{ .compatible = "nxp,ohci-nxp" },
|
|
|
{},
|
|
|
};
|
|
|
-MODULE_DEVICE_TABLE(of, usb_hcd_nxp_match);
|
|
|
+MODULE_DEVICE_TABLE(of, ohci_hcd_nxp_match);
|
|
|
#endif
|
|
|
|
|
|
-static struct platform_driver usb_hcd_nxp_driver = {
|
|
|
+static struct platform_driver ohci_hcd_nxp_driver = {
|
|
|
.driver = {
|
|
|
.name = "usb-ohci",
|
|
|
.owner = THIS_MODULE,
|
|
|
- .of_match_table = of_match_ptr(usb_hcd_nxp_match),
|
|
|
+ .of_match_table = of_match_ptr(ohci_hcd_nxp_match),
|
|
|
},
|
|
|
- .probe = usb_hcd_nxp_probe,
|
|
|
- .remove = usb_hcd_nxp_remove,
|
|
|
+ .probe = ohci_hcd_nxp_probe,
|
|
|
+ .remove = ohci_hcd_nxp_remove,
|
|
|
};
|
|
|
|
|
|
+static int __init ohci_nxp_init(void)
|
|
|
+{
|
|
|
+ if (usb_disabled())
|
|
|
+ return -ENODEV;
|
|
|
+
|
|
|
+ pr_info("%s: " DRIVER_DESC "\n", hcd_name);
|
|
|
+
|
|
|
+ ohci_init_driver(&ohci_nxp_hc_driver, NULL);
|
|
|
+ return platform_driver_register(&ohci_hcd_nxp_driver);
|
|
|
+}
|
|
|
+module_init(ohci_nxp_init);
|
|
|
+
|
|
|
+static void __exit ohci_nxp_cleanup(void)
|
|
|
+{
|
|
|
+ platform_driver_unregister(&ohci_hcd_nxp_driver);
|
|
|
+}
|
|
|
+module_exit(ohci_nxp_cleanup);
|
|
|
+
|
|
|
+MODULE_DESCRIPTION(DRIVER_DESC);
|
|
|
+MODULE_LICENSE("GPL v2");
|