| /* |
| * Setup platform devices needed by the Freescale multi-port host |
| * and/or dual-role USB controller modules based on the description |
| * in flat device tree. |
| * |
| * This program is free software; you can redistribute it and/or modify it |
| * under the terms of the GNU General Public License as published by the |
| * Free Software Foundation; either version 2 of the License, or (at your |
| * option) any later version. |
| */ |
| |
| #include <linux/kernel.h> |
| #include <linux/platform_device.h> |
| #include <linux/fsl_devices.h> |
| #include <linux/err.h> |
| #include <linux/io.h> |
| #include <linux/of_platform.h> |
| #include <linux/clk.h> |
| #include <linux/module.h> |
| |
| struct fsl_usb2_dev_data { |
| char *dr_mode; /* controller mode */ |
| char *drivers[3]; /* drivers to instantiate for this mode */ |
| enum fsl_usb2_operating_modes op_mode; /* operating mode */ |
| }; |
| |
| struct fsl_usb2_dev_data dr_mode_data[] __devinitdata = { |
| { |
| .dr_mode = "host", |
| .drivers = { "fsl-ehci", NULL, NULL, }, |
| .op_mode = FSL_USB2_DR_HOST, |
| }, |
| { |
| .dr_mode = "otg", |
| .drivers = { "fsl-usb2-otg", "fsl-ehci", "fsl-usb2-udc", }, |
| .op_mode = FSL_USB2_DR_OTG, |
| }, |
| { |
| .dr_mode = "peripheral", |
| .drivers = { "fsl-usb2-udc", NULL, NULL, }, |
| .op_mode = FSL_USB2_DR_DEVICE, |
| }, |
| }; |
| |
| struct fsl_usb2_dev_data * __devinit get_dr_mode_data(struct device_node *np) |
| { |
| const unsigned char *prop; |
| int i; |
| |
| prop = of_get_property(np, "dr_mode", NULL); |
| if (prop) { |
| for (i = 0; i < ARRAY_SIZE(dr_mode_data); i++) { |
| if (!strcmp(prop, dr_mode_data[i].dr_mode)) |
| return &dr_mode_data[i]; |
| } |
| } |
| pr_warn("%s: Invalid 'dr_mode' property, fallback to host mode\n", |
| np->full_name); |
| return &dr_mode_data[0]; /* mode not specified, use host */ |
| } |
| |
| static enum fsl_usb2_phy_modes __devinit determine_usb_phy(const char *phy_type) |
| { |
| if (!phy_type) |
| return FSL_USB2_PHY_NONE; |
| if (!strcasecmp(phy_type, "ulpi")) |
| return FSL_USB2_PHY_ULPI; |
| if (!strcasecmp(phy_type, "utmi")) |
| return FSL_USB2_PHY_UTMI; |
| if (!strcasecmp(phy_type, "utmi_wide")) |
| return FSL_USB2_PHY_UTMI_WIDE; |
| if (!strcasecmp(phy_type, "serial")) |
| return FSL_USB2_PHY_SERIAL; |
| |
| return FSL_USB2_PHY_NONE; |
| } |
| |
| struct platform_device * __devinit fsl_usb2_device_register( |
| struct platform_device *ofdev, |
| struct fsl_usb2_platform_data *pdata, |
| const char *name, int id) |
| { |
| struct platform_device *pdev; |
| const struct resource *res = ofdev->resource; |
| unsigned int num = ofdev->num_resources; |
| int retval; |
| |
| pdev = platform_device_alloc(name, id); |
| if (!pdev) { |
| retval = -ENOMEM; |
| goto error; |
| } |
| |
| pdev->dev.parent = &ofdev->dev; |
| |
| pdev->dev.coherent_dma_mask = ofdev->dev.coherent_dma_mask; |
| pdev->dev.dma_mask = &pdev->archdata.dma_mask; |
| *pdev->dev.dma_mask = *ofdev->dev.dma_mask; |
| |
| retval = platform_device_add_data(pdev, pdata, sizeof(*pdata)); |
| if (retval) |
| goto error; |
| |
| if (num) { |
| retval = platform_device_add_resources(pdev, res, num); |
| if (retval) |
| goto error; |
| } |
| |
| retval = platform_device_add(pdev); |
| if (retval) |
| goto error; |
| |
| return pdev; |
| |
| error: |
| platform_device_put(pdev); |
| return ERR_PTR(retval); |
| } |
| |
| static const struct of_device_id fsl_usb2_mph_dr_of_match[]; |
| |
| static int __devinit fsl_usb2_mph_dr_of_probe(struct platform_device *ofdev) |
| { |
| struct device_node *np = ofdev->dev.of_node; |
| struct platform_device *usb_dev; |
| struct fsl_usb2_platform_data data, *pdata; |
| struct fsl_usb2_dev_data *dev_data; |
| const struct of_device_id *match; |
| const unsigned char *prop; |
| static unsigned int idx; |
| int i; |
| |
| if (!of_device_is_available(np)) |
| return -ENODEV; |
| |
| match = of_match_device(fsl_usb2_mph_dr_of_match, &ofdev->dev); |
| if (!match) |
| return -ENODEV; |
| |
| pdata = &data; |
| if (match->data) |
| memcpy(pdata, match->data, sizeof(data)); |
| else |
| memset(pdata, 0, sizeof(data)); |
| |
| dev_data = get_dr_mode_data(np); |
| |
| if (of_device_is_compatible(np, "fsl-usb2-mph")) { |
| if (of_get_property(np, "port0", NULL)) |
| pdata->port_enables |= FSL_USB2_PORT0_ENABLED; |
| |
| if (of_get_property(np, "port1", NULL)) |
| pdata->port_enables |= FSL_USB2_PORT1_ENABLED; |
| |
| pdata->operating_mode = FSL_USB2_MPH_HOST; |
| } else { |
| if (of_get_property(np, "fsl,invert-drvvbus", NULL)) |
| pdata->invert_drvvbus = 1; |
| |
| if (of_get_property(np, "fsl,invert-pwr-fault", NULL)) |
| pdata->invert_pwr_fault = 1; |
| |
| /* setup mode selected in the device tree */ |
| pdata->operating_mode = dev_data->op_mode; |
| } |
| |
| prop = of_get_property(np, "phy_type", NULL); |
| pdata->phy_mode = determine_usb_phy(prop); |
| |
| for (i = 0; i < ARRAY_SIZE(dev_data->drivers); i++) { |
| if (!dev_data->drivers[i]) |
| continue; |
| usb_dev = fsl_usb2_device_register(ofdev, pdata, |
| dev_data->drivers[i], idx); |
| if (IS_ERR(usb_dev)) { |
| dev_err(&ofdev->dev, "Can't register usb device\n"); |
| return PTR_ERR(usb_dev); |
| } |
| } |
| idx++; |
| return 0; |
| } |
| |
| static int __devexit __unregister_subdev(struct device *dev, void *d) |
| { |
| platform_device_unregister(to_platform_device(dev)); |
| return 0; |
| } |
| |
| static int __devexit fsl_usb2_mph_dr_of_remove(struct platform_device *ofdev) |
| { |
| device_for_each_child(&ofdev->dev, NULL, __unregister_subdev); |
| return 0; |
| } |
| |
| #ifdef CONFIG_PPC_MPC512x |
| |
| #define USBGENCTRL 0x200 /* NOTE: big endian */ |
| #define GC_WU_INT_CLR (1 << 5) /* Wakeup int clear */ |
| #define GC_ULPI_SEL (1 << 4) /* ULPI i/f select (usb0 only)*/ |
| #define GC_PPP (1 << 3) /* Inv. Port Power Polarity */ |
| #define GC_PFP (1 << 2) /* Inv. Power Fault Polarity */ |
| #define GC_WU_ULPI_EN (1 << 1) /* Wakeup on ULPI event */ |
| #define GC_WU_IE (1 << 1) /* Wakeup interrupt enable */ |
| |
| #define ISIPHYCTRL 0x204 /* NOTE: big endian */ |
| #define PHYCTRL_PHYE (1 << 4) /* On-chip UTMI PHY enable */ |
| #define PHYCTRL_BSENH (1 << 3) /* Bit Stuff Enable High */ |
| #define PHYCTRL_BSEN (1 << 2) /* Bit Stuff Enable */ |
| #define PHYCTRL_LSFE (1 << 1) /* Line State Filter Enable */ |
| #define PHYCTRL_PXE (1 << 0) /* PHY oscillator enable */ |
| |
| int fsl_usb2_mpc5121_init(struct platform_device *pdev) |
| { |
| struct fsl_usb2_platform_data *pdata = pdev->dev.platform_data; |
| struct clk *clk; |
| char clk_name[10]; |
| int base, clk_num; |
| |
| base = pdev->resource->start & 0xf000; |
| if (base == 0x3000) |
| clk_num = 1; |
| else if (base == 0x4000) |
| clk_num = 2; |
| else |
| return -ENODEV; |
| |
| snprintf(clk_name, sizeof(clk_name), "usb%d_clk", clk_num); |
| clk = clk_get(&pdev->dev, clk_name); |
| if (IS_ERR(clk)) { |
| dev_err(&pdev->dev, "failed to get clk\n"); |
| return PTR_ERR(clk); |
| } |
| |
| clk_enable(clk); |
| pdata->clk = clk; |
| |
| if (pdata->phy_mode == FSL_USB2_PHY_UTMI_WIDE) { |
| u32 reg = 0; |
| |
| if (pdata->invert_drvvbus) |
| reg |= GC_PPP; |
| |
| if (pdata->invert_pwr_fault) |
| reg |= GC_PFP; |
| |
| out_be32(pdata->regs + ISIPHYCTRL, PHYCTRL_PHYE | PHYCTRL_PXE); |
| out_be32(pdata->regs + USBGENCTRL, reg); |
| } |
| return 0; |
| } |
| |
| static void fsl_usb2_mpc5121_exit(struct platform_device *pdev) |
| { |
| struct fsl_usb2_platform_data *pdata = pdev->dev.platform_data; |
| |
| pdata->regs = NULL; |
| |
| if (pdata->clk) { |
| clk_disable(pdata->clk); |
| clk_put(pdata->clk); |
| } |
| } |
| |
| static struct fsl_usb2_platform_data fsl_usb2_mpc5121_pd = { |
| .big_endian_desc = 1, |
| .big_endian_mmio = 1, |
| .es = 1, |
| .have_sysif_regs = 0, |
| .le_setup_buf = 1, |
| .init = fsl_usb2_mpc5121_init, |
| .exit = fsl_usb2_mpc5121_exit, |
| }; |
| #endif /* CONFIG_PPC_MPC512x */ |
| |
| static struct fsl_usb2_platform_data fsl_usb2_mpc8xxx_pd = { |
| .have_sysif_regs = 1, |
| }; |
| |
| static const struct of_device_id fsl_usb2_mph_dr_of_match[] = { |
| { .compatible = "fsl-usb2-mph", .data = &fsl_usb2_mpc8xxx_pd, }, |
| { .compatible = "fsl-usb2-dr", .data = &fsl_usb2_mpc8xxx_pd, }, |
| #ifdef CONFIG_PPC_MPC512x |
| { .compatible = "fsl,mpc5121-usb2-dr", .data = &fsl_usb2_mpc5121_pd, }, |
| #endif |
| {}, |
| }; |
| |
| static struct platform_driver fsl_usb2_mph_dr_driver = { |
| .driver = { |
| .name = "fsl-usb2-mph-dr", |
| .owner = THIS_MODULE, |
| .of_match_table = fsl_usb2_mph_dr_of_match, |
| }, |
| .probe = fsl_usb2_mph_dr_of_probe, |
| .remove = __devexit_p(fsl_usb2_mph_dr_of_remove), |
| }; |
| |
| static int __init fsl_usb2_mph_dr_init(void) |
| { |
| return platform_driver_register(&fsl_usb2_mph_dr_driver); |
| } |
| module_init(fsl_usb2_mph_dr_init); |
| |
| static void __exit fsl_usb2_mph_dr_exit(void) |
| { |
| platform_driver_unregister(&fsl_usb2_mph_dr_driver); |
| } |
| module_exit(fsl_usb2_mph_dr_exit); |
| |
| MODULE_DESCRIPTION("FSL MPH DR OF devices driver"); |
| MODULE_AUTHOR("Anatolij Gustschin <agust@denx.de>"); |
| MODULE_LICENSE("GPL"); |