mirror of https://github.com/Qortal/Brooklyn
You can not select more than 25 topics
Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
373 lines
9.8 KiB
373 lines
9.8 KiB
// SPDX-License-Identifier: GPL-2.0+ |
|
/* |
|
* 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. |
|
*/ |
|
|
|
#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> |
|
#include <linux/dma-mapping.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 */ |
|
}; |
|
|
|
static struct fsl_usb2_dev_data dr_mode_data[] = { |
|
{ |
|
.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, |
|
}, |
|
}; |
|
|
|
static struct fsl_usb2_dev_data *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("%pOF: Invalid 'dr_mode' property, fallback to host mode\n", |
|
np); |
|
return &dr_mode_data[0]; /* mode not specified, use host */ |
|
} |
|
|
|
static enum fsl_usb2_phy_modes 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, "utmi_dual")) |
|
return FSL_USB2_PHY_UTMI_DUAL; |
|
if (!strcasecmp(phy_type, "serial")) |
|
return FSL_USB2_PHY_SERIAL; |
|
|
|
return FSL_USB2_PHY_NONE; |
|
} |
|
|
|
static struct platform_device *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; |
|
|
|
if (!pdev->dev.dma_mask) { |
|
pdev->dev.dma_mask = &ofdev->dev.coherent_dma_mask; |
|
} else { |
|
retval = dma_set_mask(&pdev->dev, DMA_BIT_MASK(32)); |
|
if (retval) |
|
goto error; |
|
} |
|
|
|
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 enum fsl_usb2_controller_ver usb_get_ver_info(struct device_node *np) |
|
{ |
|
enum fsl_usb2_controller_ver ver = FSL_USB_VER_NONE; |
|
|
|
/* |
|
* returns 1 for usb controller version 1.6 |
|
* returns 2 for usb controller version 2.2 |
|
* returns 3 for usb controller version 2.4 |
|
* returns 4 for usb controller version 2.5 |
|
* returns 0 otherwise |
|
*/ |
|
if (of_device_is_compatible(np, "fsl-usb2-dr")) { |
|
if (of_device_is_compatible(np, "fsl-usb2-dr-v1.6")) |
|
ver = FSL_USB_VER_1_6; |
|
else if (of_device_is_compatible(np, "fsl-usb2-dr-v2.2")) |
|
ver = FSL_USB_VER_2_2; |
|
else if (of_device_is_compatible(np, "fsl-usb2-dr-v2.4")) |
|
ver = FSL_USB_VER_2_4; |
|
else if (of_device_is_compatible(np, "fsl-usb2-dr-v2.5")) |
|
ver = FSL_USB_VER_2_5; |
|
else /* for previous controller versions */ |
|
ver = FSL_USB_VER_OLD; |
|
|
|
if (ver > FSL_USB_VER_NONE) |
|
return ver; |
|
} |
|
|
|
if (of_device_is_compatible(np, "fsl,mpc5121-usb2-dr")) |
|
return FSL_USB_VER_OLD; |
|
|
|
if (of_device_is_compatible(np, "fsl-usb2-mph")) { |
|
if (of_device_is_compatible(np, "fsl-usb2-mph-v1.6")) |
|
ver = FSL_USB_VER_1_6; |
|
else if (of_device_is_compatible(np, "fsl-usb2-mph-v2.2")) |
|
ver = FSL_USB_VER_2_2; |
|
else if (of_device_is_compatible(np, "fsl-usb2-mph-v2.4")) |
|
ver = FSL_USB_VER_2_4; |
|
else if (of_device_is_compatible(np, "fsl-usb2-mph-v2.5")) |
|
ver = FSL_USB_VER_2_5; |
|
else /* for previous controller versions */ |
|
ver = FSL_USB_VER_OLD; |
|
} |
|
|
|
return ver; |
|
} |
|
|
|
static int 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); |
|
pdata->controller_ver = usb_get_ver_info(np); |
|
|
|
/* Activate Erratum by reading property in device tree */ |
|
pdata->has_fsl_erratum_a007792 = |
|
of_property_read_bool(np, "fsl,usb-erratum-a007792"); |
|
pdata->has_fsl_erratum_a005275 = |
|
of_property_read_bool(np, "fsl,usb-erratum-a005275"); |
|
pdata->has_fsl_erratum_a005697 = |
|
of_property_read_bool(np, "fsl,usb_erratum-a005697"); |
|
pdata->has_fsl_erratum_a006918 = |
|
of_property_read_bool(np, "fsl,usb_erratum-a006918"); |
|
pdata->has_fsl_erratum_14 = |
|
of_property_read_bool(np, "fsl,usb_erratum-14"); |
|
|
|
/* |
|
* Determine whether phy_clk_valid needs to be checked |
|
* by reading property in device tree |
|
*/ |
|
pdata->check_phy_clk_valid = |
|
of_property_read_bool(np, "phy-clk-valid"); |
|
|
|
if (pdata->have_sysif_regs) { |
|
if (pdata->controller_ver == FSL_USB_VER_NONE) { |
|
dev_warn(&ofdev->dev, "Could not get controller version\n"); |
|
return -ENODEV; |
|
} |
|
} |
|
|
|
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 __unregister_subdev(struct device *dev, void *d) |
|
{ |
|
platform_device_unregister(to_platform_device(dev)); |
|
return 0; |
|
} |
|
|
|
static int 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 = dev_get_platdata(&pdev->dev); |
|
struct clk *clk; |
|
int err; |
|
|
|
clk = devm_clk_get(pdev->dev.parent, "ipg"); |
|
if (IS_ERR(clk)) { |
|
dev_err(&pdev->dev, "failed to get clk\n"); |
|
return PTR_ERR(clk); |
|
} |
|
err = clk_prepare_enable(clk); |
|
if (err) { |
|
dev_err(&pdev->dev, "failed to enable clk\n"); |
|
return err; |
|
} |
|
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 = dev_get_platdata(&pdev->dev); |
|
|
|
pdata->regs = NULL; |
|
|
|
if (pdata->clk) |
|
clk_disable_unprepare(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 |
|
{}, |
|
}; |
|
MODULE_DEVICE_TABLE(of, fsl_usb2_mph_dr_of_match); |
|
|
|
static struct platform_driver fsl_usb2_mph_dr_driver = { |
|
.driver = { |
|
.name = "fsl-usb2-mph-dr", |
|
.of_match_table = fsl_usb2_mph_dr_of_match, |
|
}, |
|
.probe = fsl_usb2_mph_dr_of_probe, |
|
.remove = fsl_usb2_mph_dr_of_remove, |
|
}; |
|
|
|
module_platform_driver(fsl_usb2_mph_dr_driver); |
|
|
|
MODULE_DESCRIPTION("FSL MPH DR OF devices driver"); |
|
MODULE_AUTHOR("Anatolij Gustschin <[email protected]>"); |
|
MODULE_LICENSE("GPL");
|
|
|