[deliverable/linux.git] / drivers / usb / host / fsl-mph-dr-of.c

/*
 * 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>
#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("%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 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
		dma_set_mask(&pdev->dev, DMA_BIT_MASK(32));

	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");

	/*
	 * 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 <agust@denx.de>");
MODULE_LICENSE("GPL");
Commit	Line	Data
126512e3 AG	1	/*
	2	* Setup platform devices needed by the Freescale multi-port host
	3	* and/or dual-role USB controller modules based on the description
	4	* in flat device tree.
	5	*
	6	* This program is free software; you can redistribute it and/or modify it
	7	* under the terms of the GNU General Public License as published by the
	8	* Free Software Foundation; either version 2 of the License, or (at your
	9	* option) any later version.
	10	*/
	11
	12	#include <linux/kernel.h>
	13	#include <linux/platform_device.h>
	14	#include <linux/fsl_devices.h>
	15	#include <linux/err.h>
	16	#include <linux/io.h>
	17	#include <linux/of_platform.h>
230f7ede	18	#include <linux/clk.h>
6eb0de82	19	#include <linux/module.h>
cae05861	20	#include <linux/dma-mapping.h>
126512e3 AG	21
	22	struct fsl_usb2_dev_data {
	23	char dr_mode; / controller mode */
	24	char drivers[3]; / drivers to instantiate for this mode */
	25	enum fsl_usb2_operating_modes op_mode; /* operating mode */
	26	};
	27
660479aa	28	static struct fsl_usb2_dev_data dr_mode_data[] = {
126512e3 AG	29	{
	30	.dr_mode = "host",
	31	.drivers = { "fsl-ehci", NULL, NULL, },
	32	.op_mode = FSL_USB2_DR_HOST,
	33	},
	34	{
	35	.dr_mode = "otg",
	36	.drivers = { "fsl-usb2-otg", "fsl-ehci", "fsl-usb2-udc", },
	37	.op_mode = FSL_USB2_DR_OTG,
	38	},
	39	{
	40	.dr_mode = "peripheral",
	41	.drivers = { "fsl-usb2-udc", NULL, NULL, },
	42	.op_mode = FSL_USB2_DR_DEVICE,
	43	},
	44	};
	45
660479aa	46	static struct fsl_usb2_dev_data get_dr_mode_data(struct device_node np)
126512e3 AG	47	{
	48	const unsigned char *prop;
	49	int i;
	50
	51	prop = of_get_property(np, "dr_mode", NULL);
	52	if (prop) {
	53	for (i = 0; i < ARRAY_SIZE(dr_mode_data); i++) {
	54	if (!strcmp(prop, dr_mode_data[i].dr_mode))
	55	return &dr_mode_data[i];
	56	}
	57	}
	58	pr_warn("%s: Invalid 'dr_mode' property, fallback to host mode\n",
	59	np->full_name);
	60	return &dr_mode_data[0]; /* mode not specified, use host */
	61	}
	62
41ac7b3a	63	static enum fsl_usb2_phy_modes determine_usb_phy(const char *phy_type)
126512e3 AG	64	{
	65	if (!phy_type)
	66	return FSL_USB2_PHY_NONE;
	67	if (!strcasecmp(phy_type, "ulpi"))
	68	return FSL_USB2_PHY_ULPI;
	69	if (!strcasecmp(phy_type, "utmi"))
	70	return FSL_USB2_PHY_UTMI;
	71	if (!strcasecmp(phy_type, "utmi_wide"))
	72	return FSL_USB2_PHY_UTMI_WIDE;
6009d95e NB	73	if (!strcasecmp(phy_type, "utmi_dual"))
6009d95e NB	74	return FSL_USB2_PHY_UTMI_DUAL;
126512e3 AG	75	if (!strcasecmp(phy_type, "serial"))
	76	return FSL_USB2_PHY_SERIAL;
	77
	78	return FSL_USB2_PHY_NONE;
	79	}
	80
660479aa	81	static struct platform_device *fsl_usb2_device_register(
126512e3 AG	82	struct platform_device *ofdev,
	83	struct fsl_usb2_platform_data *pdata,
	84	const char *name, int id)
	85	{
	86	struct platform_device *pdev;
	87	const struct resource *res = ofdev->resource;
	88	unsigned int num = ofdev->num_resources;
	89	int retval;
	90
	91	pdev = platform_device_alloc(name, id);
	92	if (!pdev) {
	93	retval = -ENOMEM;
	94	goto error;
	95	}
	96
	97	pdev->dev.parent = &ofdev->dev;
	98
	99	pdev->dev.coherent_dma_mask = ofdev->dev.coherent_dma_mask;
cae05861 SD	100
	101	if (!pdev->dev.dma_mask)
	102	pdev->dev.dma_mask = &ofdev->dev.coherent_dma_mask;
	103	else
	104	dma_set_mask(&pdev->dev, DMA_BIT_MASK(32));
126512e3 AG	105
	106	retval = platform_device_add_data(pdev, pdata, sizeof(*pdata));
	107	if (retval)
	108	goto error;
	109
	110	if (num) {
	111	retval = platform_device_add_resources(pdev, res, num);
	112	if (retval)
	113	goto error;
	114	}
	115
	116	retval = platform_device_add(pdev);
	117	if (retval)
	118	goto error;
	119
	120	return pdev;
	121
	122	error:
	123	platform_device_put(pdev);
	124	return ERR_PTR(retval);
	125	}
	126
	127	static const struct of_device_id fsl_usb2_mph_dr_of_match[];
	128
38aa4200	129	static enum fsl_usb2_controller_ver usb_get_ver_info(struct device_node *np)
58c559e6	130	{
38aa4200	131	enum fsl_usb2_controller_ver ver = FSL_USB_VER_NONE;
58c559e6 RM	132
	133	/*
	134	* returns 1 for usb controller version 1.6
	135	* returns 2 for usb controller version 2.2
d7c444e5	136	* returns 3 for usb controller version 2.4
138c3f03	137	* returns 4 for usb controller version 2.5
58c559e6 RM	138	* returns 0 otherwise
	139	*/
	140	if (of_device_is_compatible(np, "fsl-usb2-dr")) {
	141	if (of_device_is_compatible(np, "fsl-usb2-dr-v1.6"))
	142	ver = FSL_USB_VER_1_6;
	143	else if (of_device_is_compatible(np, "fsl-usb2-dr-v2.2"))
	144	ver = FSL_USB_VER_2_2;
e98b6a4f RM	145	else if (of_device_is_compatible(np, "fsl-usb2-dr-v2.4"))
e98b6a4f RM	146	ver = FSL_USB_VER_2_4;
138c3f03 NB	147	else if (of_device_is_compatible(np, "fsl-usb2-dr-v2.5"))
138c3f03 NB	148	ver = FSL_USB_VER_2_5;
58c559e6 RM	149	else /* for previous controller versions */
	150	ver = FSL_USB_VER_OLD;
	151
38aa4200	152	if (ver > FSL_USB_VER_NONE)
58c559e6 RM	153	return ver;
	154	}
	155
7c1029ba AG	156	if (of_device_is_compatible(np, "fsl,mpc5121-usb2-dr"))
	157	return FSL_USB_VER_OLD;
	158
58c559e6 RM	159	if (of_device_is_compatible(np, "fsl-usb2-mph")) {
	160	if (of_device_is_compatible(np, "fsl-usb2-mph-v1.6"))
	161	ver = FSL_USB_VER_1_6;
	162	else if (of_device_is_compatible(np, "fsl-usb2-mph-v2.2"))
	163	ver = FSL_USB_VER_2_2;
d7c444e5 NB	164	else if (of_device_is_compatible(np, "fsl-usb2-mph-v2.4"))
d7c444e5 NB	165	ver = FSL_USB_VER_2_4;
138c3f03 NB	166	else if (of_device_is_compatible(np, "fsl-usb2-mph-v2.5"))
138c3f03 NB	167	ver = FSL_USB_VER_2_5;
58c559e6 RM	168	else /* for previous controller versions */
	169	ver = FSL_USB_VER_OLD;
	170	}
	171
	172	return ver;
	173	}
	174
41ac7b3a	175	static int fsl_usb2_mph_dr_of_probe(struct platform_device *ofdev)
126512e3 AG	176	{
	177	struct device_node *np = ofdev->dev.of_node;
	178	struct platform_device *usb_dev;
	179	struct fsl_usb2_platform_data data, *pdata;
	180	struct fsl_usb2_dev_data *dev_data;
	181	const struct of_device_id *match;
	182	const unsigned char *prop;
	183	static unsigned int idx;
	184	int i;
	185
	186	if (!of_device_is_available(np))
	187	return -ENODEV;
	188
	189	match = of_match_device(fsl_usb2_mph_dr_of_match, &ofdev->dev);
	190	if (!match)
	191	return -ENODEV;
	192
	193	pdata = &data;
	194	if (match->data)
	195	memcpy(pdata, match->data, sizeof(data));
	196	else
	197	memset(pdata, 0, sizeof(data));
	198
	199	dev_data = get_dr_mode_data(np);
	200
	201	if (of_device_is_compatible(np, "fsl-usb2-mph")) {
	202	if (of_get_property(np, "port0", NULL))
	203	pdata->port_enables \|= FSL_USB2_PORT0_ENABLED;
	204
	205	if (of_get_property(np, "port1", NULL))
	206	pdata->port_enables \|= FSL_USB2_PORT1_ENABLED;
	207
	208	pdata->operating_mode = FSL_USB2_MPH_HOST;
	209	} else {
230f7ede AG	210	if (of_get_property(np, "fsl,invert-drvvbus", NULL))
	211	pdata->invert_drvvbus = 1;
	212
	213	if (of_get_property(np, "fsl,invert-pwr-fault", NULL))
	214	pdata->invert_pwr_fault = 1;
	215
126512e3 AG	216	/* setup mode selected in the device tree */
	217	pdata->operating_mode = dev_data->op_mode;
	218	}
	219
	220	prop = of_get_property(np, "phy_type", NULL);
	221	pdata->phy_mode = determine_usb_phy(prop);
58c559e6 RM	222	pdata->controller_ver = usb_get_ver_info(np);
58c559e6 RM	223
523f1dec	224	/* Activate Erratum by reading property in device tree */
72cd194f JL	225	pdata->has_fsl_erratum_a007792 =
	226	of_property_read_bool(np, "fsl,usb-erratum-a007792");
	227	pdata->has_fsl_erratum_a005275 =
	228	of_property_read_bool(np, "fsl,usb-erratum-a005275");
523f1dec	229
f4fdfaa2 NB	230	/*
	231	* Determine whether phy_clk_valid needs to be checked
	232	* by reading property in device tree
	233	*/
72cd194f JL	234	pdata->check_phy_clk_valid =
72cd194f JL	235	of_property_read_bool(np, "phy-clk-valid");
f4fdfaa2	236
58c559e6	237	if (pdata->have_sysif_regs) {
38aa4200	238	if (pdata->controller_ver == FSL_USB_VER_NONE) {
58c559e6 RM	239	dev_warn(&ofdev->dev, "Could not get controller version\n");
	240	return -ENODEV;
	241	}
	242	}
126512e3 AG	243
	244	for (i = 0; i < ARRAY_SIZE(dev_data->drivers); i++) {
	245	if (!dev_data->drivers[i])
	246	continue;
	247	usb_dev = fsl_usb2_device_register(ofdev, pdata,
	248	dev_data->drivers[i], idx);
	249	if (IS_ERR(usb_dev)) {
	250	dev_err(&ofdev->dev, "Can't register usb device\n");
	251	return PTR_ERR(usb_dev);
	252	}
	253	}
	254	idx++;
	255	return 0;
	256	}
	257
fb4e98ab	258	static int __unregister_subdev(struct device dev, void d)
126512e3 AG	259	{
	260	platform_device_unregister(to_platform_device(dev));
	261	return 0;
	262	}
	263
fb4e98ab	264	static int fsl_usb2_mph_dr_of_remove(struct platform_device *ofdev)
126512e3 AG	265	{
	266	device_for_each_child(&ofdev->dev, NULL, __unregister_subdev);
	267	return 0;
	268	}
	269
230f7ede AG	270	#ifdef CONFIG_PPC_MPC512x
	271
	272	#define USBGENCTRL 0x200 /* NOTE: big endian */
	273	#define GC_WU_INT_CLR (1 << 5) /* Wakeup int clear */
	274	#define GC_ULPI_SEL (1 << 4) /* ULPI i/f select (usb0 only)*/
	275	#define GC_PPP (1 << 3) /* Inv. Port Power Polarity */
	276	#define GC_PFP (1 << 2) /* Inv. Power Fault Polarity */
	277	#define GC_WU_ULPI_EN (1 << 1) /* Wakeup on ULPI event */
	278	#define GC_WU_IE (1 << 1) /* Wakeup interrupt enable */
	279
	280	#define ISIPHYCTRL 0x204 /* NOTE: big endian */
	281	#define PHYCTRL_PHYE (1 << 4) /* On-chip UTMI PHY enable */
	282	#define PHYCTRL_BSENH (1 << 3) /* Bit Stuff Enable High */
	283	#define PHYCTRL_BSEN (1 << 2) /* Bit Stuff Enable */
	284	#define PHYCTRL_LSFE (1 << 1) /* Line State Filter Enable */
	285	#define PHYCTRL_PXE (1 << 0) /* PHY oscillator enable */
	286
	287	int fsl_usb2_mpc5121_init(struct platform_device *pdev)
	288	{
d4f09e28	289	struct fsl_usb2_platform_data *pdata = dev_get_platdata(&pdev->dev);
230f7ede	290	struct clk *clk;
7282bdb2	291	int err;
230f7ede	292
d77276c4	293	clk = devm_clk_get(pdev->dev.parent, "ipg");
230f7ede AG	294	if (IS_ERR(clk)) {
	295	dev_err(&pdev->dev, "failed to get clk\n");
	296	return PTR_ERR(clk);
	297	}
7282bdb2 GS	298	err = clk_prepare_enable(clk);
	299	if (err) {
	300	dev_err(&pdev->dev, "failed to enable clk\n");
	301	return err;
	302	}
230f7ede AG	303	pdata->clk = clk;
	304
	305	if (pdata->phy_mode == FSL_USB2_PHY_UTMI_WIDE) {
	306	u32 reg = 0;
	307
	308	if (pdata->invert_drvvbus)
	309	reg \|= GC_PPP;
	310
	311	if (pdata->invert_pwr_fault)
	312	reg \|= GC_PFP;
	313
	314	out_be32(pdata->regs + ISIPHYCTRL, PHYCTRL_PHYE \| PHYCTRL_PXE);
	315	out_be32(pdata->regs + USBGENCTRL, reg);
	316	}
	317	return 0;
	318	}
	319
	320	static void fsl_usb2_mpc5121_exit(struct platform_device *pdev)
	321	{
d4f09e28	322	struct fsl_usb2_platform_data *pdata = dev_get_platdata(&pdev->dev);
230f7ede AG	323
	324	pdata->regs = NULL;
	325
7282bdb2 GS	326	if (pdata->clk)
7282bdb2 GS	327	clk_disable_unprepare(pdata->clk);
230f7ede AG	328	}
230f7ede AG	329
cc604ddd	330	static struct fsl_usb2_platform_data fsl_usb2_mpc5121_pd = {
230f7ede AG	331	.big_endian_desc = 1,
	332	.big_endian_mmio = 1,
	333	.es = 1,
cc604ddd	334	.have_sysif_regs = 0,
230f7ede AG	335	.le_setup_buf = 1,
	336	.init = fsl_usb2_mpc5121_init,
	337	.exit = fsl_usb2_mpc5121_exit,
	338	};
	339	#endif /* CONFIG_PPC_MPC512x */
	340
cc604ddd PT	341	static struct fsl_usb2_platform_data fsl_usb2_mpc8xxx_pd = {
	342	.have_sysif_regs = 1,
	343	};
	344
126512e3	345	static const struct of_device_id fsl_usb2_mph_dr_of_match[] = {
cc604ddd PT	346	{ .compatible = "fsl-usb2-mph", .data = &fsl_usb2_mpc8xxx_pd, },
cc604ddd PT	347	{ .compatible = "fsl-usb2-dr", .data = &fsl_usb2_mpc8xxx_pd, },
230f7ede AG	348	#ifdef CONFIG_PPC_MPC512x
	349	{ .compatible = "fsl,mpc5121-usb2-dr", .data = &fsl_usb2_mpc5121_pd, },
	350	#endif
126512e3 AG	351	{},
126512e3 AG	352	};
8ddb9b88	353	MODULE_DEVICE_TABLE(of, fsl_usb2_mph_dr_of_match);
126512e3 AG	354
	355	static struct platform_driver fsl_usb2_mph_dr_driver = {
	356	.driver = {
	357	.name = "fsl-usb2-mph-dr",
126512e3 AG	358	.of_match_table = fsl_usb2_mph_dr_of_match,
	359	},
	360	.probe = fsl_usb2_mph_dr_of_probe,
7690417d	361	.remove = fsl_usb2_mph_dr_of_remove,
126512e3 AG	362	};
126512e3 AG	363
cc27c96c	364	module_platform_driver(fsl_usb2_mph_dr_driver);
126512e3 AG	365
	366	MODULE_DESCRIPTION("FSL MPH DR OF devices driver");
	367	MODULE_AUTHOR("Anatolij Gustschin <agust@denx.de>");
	368	MODULE_LICENSE("GPL");