[deliverable/linux.git] / drivers / usb / musb / ux500.c

/*
 * Copyright (C) 2010 ST-Ericsson AB
 * Mian Yousaf Kaukab <mian.yousaf.kaukab@stericsson.com>
 *
 * Based on omap2430.c
 *
 * 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.
 *
 * This program is distributed in the hope that it will be useful,
 * but WITHOUT ANY WARRANTY; without even the implied warranty of
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 * GNU General Public License for more details.
 *
 * You should have received a copy of the GNU General Public License
 * along with this program; if not, write to the Free Software
 * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
 */

#include <linux/module.h>
#include <linux/kernel.h>
#include <linux/init.h>
#include <linux/clk.h>
#include <linux/io.h>
#include <linux/platform_device.h>

#include "musb_core.h"

struct ux500_glue {
	struct device		*dev;
	struct platform_device	*musb;
	struct clk		*clk;
};
#define glue_to_musb(g)	platform_get_drvdata(g->musb)

static int ux500_musb_init(struct musb *musb)
{
	musb->xceiv = usb_get_phy();
	if (!musb->xceiv) {
		pr_err("HS USB OTG: no transceiver configured\n");
		return -ENODEV;
	}

	return 0;
}

static int ux500_musb_exit(struct musb *musb)
{
	usb_put_phy(musb->xceiv);

	return 0;
}

static const struct musb_platform_ops ux500_ops = {
	.init		= ux500_musb_init,
	.exit		= ux500_musb_exit,
};

static int __devinit ux500_probe(struct platform_device *pdev)
{
	struct musb_hdrc_platform_data	*pdata = pdev->dev.platform_data;
	struct platform_device		*musb;
	struct ux500_glue		*glue;
	struct clk			*clk;

	int				ret = -ENOMEM;

	glue = kzalloc(sizeof(*glue), GFP_KERNEL);
	if (!glue) {
		dev_err(&pdev->dev, "failed to allocate glue context\n");
		goto err0;
	}

	musb = platform_device_alloc("musb-hdrc", -1);
	if (!musb) {
		dev_err(&pdev->dev, "failed to allocate musb device\n");
		goto err1;
	}

	clk = clk_get(&pdev->dev, "usb");
	if (IS_ERR(clk)) {
		dev_err(&pdev->dev, "failed to get clock\n");
		ret = PTR_ERR(clk);
		goto err2;
	}

	ret = clk_enable(clk);
	if (ret) {
		dev_err(&pdev->dev, "failed to enable clock\n");
		goto err3;
	}

	musb->dev.parent		= &pdev->dev;
	musb->dev.dma_mask		= pdev->dev.dma_mask;
	musb->dev.coherent_dma_mask	= pdev->dev.coherent_dma_mask;

	glue->dev			= &pdev->dev;
	glue->musb			= musb;
	glue->clk			= clk;

	pdata->platform_ops		= &ux500_ops;

	platform_set_drvdata(pdev, glue);

	ret = platform_device_add_resources(musb, pdev->resource,
			pdev->num_resources);
	if (ret) {
		dev_err(&pdev->dev, "failed to add resources\n");
		goto err4;
	}

	ret = platform_device_add_data(musb, pdata, sizeof(*pdata));
	if (ret) {
		dev_err(&pdev->dev, "failed to add platform_data\n");
		goto err4;
	}

	ret = platform_device_add(musb);
	if (ret) {
		dev_err(&pdev->dev, "failed to register musb device\n");
		goto err4;
	}

	return 0;

err4:
	clk_disable(clk);

err3:
	clk_put(clk);

err2:
	platform_device_put(musb);

err1:
	kfree(glue);

err0:
	return ret;
}

static int __devexit ux500_remove(struct platform_device *pdev)
{
	struct ux500_glue	*glue = platform_get_drvdata(pdev);

	platform_device_del(glue->musb);
	platform_device_put(glue->musb);
	clk_disable(glue->clk);
	clk_put(glue->clk);
	kfree(glue);

	return 0;
}

#ifdef CONFIG_PM
static int ux500_suspend(struct device *dev)
{
	struct ux500_glue	*glue = dev_get_drvdata(dev);
	struct musb		*musb = glue_to_musb(glue);

	usb_phy_set_suspend(musb->xceiv, 1);
	clk_disable(glue->clk);

	return 0;
}

static int ux500_resume(struct device *dev)
{
	struct ux500_glue	*glue = dev_get_drvdata(dev);
	struct musb		*musb = glue_to_musb(glue);
	int			ret;

	ret = clk_enable(glue->clk);
	if (ret) {
		dev_err(dev, "failed to enable clock\n");
		return ret;
	}

	usb_phy_set_suspend(musb->xceiv, 0);

	return 0;
}

static const struct dev_pm_ops ux500_pm_ops = {
	.suspend	= ux500_suspend,
	.resume		= ux500_resume,
};

#define DEV_PM_OPS	(&ux500_pm_ops)
#else
#define DEV_PM_OPS	NULL
#endif

static struct platform_driver ux500_driver = {
	.probe		= ux500_probe,
	.remove		= __devexit_p(ux500_remove),
	.driver		= {
		.name	= "musb-ux500",
		.pm	= DEV_PM_OPS,
	},
};

MODULE_DESCRIPTION("UX500 MUSB Glue Layer");
MODULE_AUTHOR("Mian Yousaf Kaukab <mian.yousaf.kaukab@stericsson.com>");
MODULE_LICENSE("GPL v2");

static int __init ux500_init(void)
{
	return platform_driver_register(&ux500_driver);
}
module_init(ux500_init);

static void __exit ux500_exit(void)
{
	platform_driver_unregister(&ux500_driver);
}
module_exit(ux500_exit);
Commit	Line	Data
4bc36fd3 MYK	1	/*
	2	* Copyright (C) 2010 ST-Ericsson AB
	3	* Mian Yousaf Kaukab <mian.yousaf.kaukab@stericsson.com>
	4	*
	5	* Based on omap2430.c
	6	*
	7	* This program is free software; you can redistribute it and/or modify
	8	* it under the terms of the GNU General Public License as published by
	9	* the Free Software Foundation; either version 2 of the License, or
	10	* (at your option) any later version.
	11	*
	12	* This program is distributed in the hope that it will be useful,
	13	* but WITHOUT ANY WARRANTY; without even the implied warranty of
	14	* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
	15	* GNU General Public License for more details.
	16	*
	17	* You should have received a copy of the GNU General Public License
	18	* along with this program; if not, write to the Free Software
	19	* Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
	20	*/
	21
	22	#include <linux/module.h>
	23	#include <linux/kernel.h>
	24	#include <linux/init.h>
	25	#include <linux/clk.h>
	26	#include <linux/io.h>
	27	#include <linux/platform_device.h>
	28
	29	#include "musb_core.h"
	30
	31	struct ux500_glue {
	32	struct device *dev;
	33	struct platform_device *musb;
	34	struct clk *clk;
	35	};
	36	#define glue_to_musb(g) platform_get_drvdata(g->musb)
	37
	38	static int ux500_musb_init(struct musb *musb)
	39	{
721002ec	40	musb->xceiv = usb_get_phy();
4bc36fd3 MYK	41	if (!musb->xceiv) {
	42	pr_err("HS USB OTG: no transceiver configured\n");
	43	return -ENODEV;
	44	}
	45
	46	return 0;
	47	}
	48
	49	static int ux500_musb_exit(struct musb *musb)
	50	{
721002ec	51	usb_put_phy(musb->xceiv);
4bc36fd3 MYK	52
	53	return 0;
	54	}
	55
	56	static const struct musb_platform_ops ux500_ops = {
	57	.init = ux500_musb_init,
	58	.exit = ux500_musb_exit,
	59	};
	60
e9e8c85e	61	static int __devinit ux500_probe(struct platform_device *pdev)
4bc36fd3 MYK	62	{
	63	struct musb_hdrc_platform_data *pdata = pdev->dev.platform_data;
	64	struct platform_device *musb;
	65	struct ux500_glue *glue;
	66	struct clk *clk;
	67
	68	int ret = -ENOMEM;
	69
	70	glue = kzalloc(sizeof(*glue), GFP_KERNEL);
	71	if (!glue) {
	72	dev_err(&pdev->dev, "failed to allocate glue context\n");
	73	goto err0;
	74	}
	75
	76	musb = platform_device_alloc("musb-hdrc", -1);
	77	if (!musb) {
	78	dev_err(&pdev->dev, "failed to allocate musb device\n");
	79	goto err1;
	80	}
	81
	82	clk = clk_get(&pdev->dev, "usb");
	83	if (IS_ERR(clk)) {
	84	dev_err(&pdev->dev, "failed to get clock\n");
	85	ret = PTR_ERR(clk);
	86	goto err2;
	87	}
	88
	89	ret = clk_enable(clk);
	90	if (ret) {
	91	dev_err(&pdev->dev, "failed to enable clock\n");
	92	goto err3;
	93	}
	94
	95	musb->dev.parent = &pdev->dev;
87266064 MYK	96	musb->dev.dma_mask = pdev->dev.dma_mask;
87266064 MYK	97	musb->dev.coherent_dma_mask = pdev->dev.coherent_dma_mask;
4bc36fd3 MYK	98
	99	glue->dev = &pdev->dev;
	100	glue->musb = musb;
	101	glue->clk = clk;
	102
	103	pdata->platform_ops = &ux500_ops;
	104
	105	platform_set_drvdata(pdev, glue);
	106
	107	ret = platform_device_add_resources(musb, pdev->resource,
	108	pdev->num_resources);
	109	if (ret) {
	110	dev_err(&pdev->dev, "failed to add resources\n");
	111	goto err4;
	112	}
	113
	114	ret = platform_device_add_data(musb, pdata, sizeof(*pdata));
	115	if (ret) {
	116	dev_err(&pdev->dev, "failed to add platform_data\n");
	117	goto err4;
	118	}
	119
	120	ret = platform_device_add(musb);
	121	if (ret) {
	122	dev_err(&pdev->dev, "failed to register musb device\n");
	123	goto err4;
	124	}
	125
	126	return 0;
	127
	128	err4:
	129	clk_disable(clk);
	130
	131	err3:
	132	clk_put(clk);
	133
	134	err2:
	135	platform_device_put(musb);
	136
	137	err1:
	138	kfree(glue);
	139
	140	err0:
	141	return ret;
	142	}
	143
e9e8c85e	144	static int __devexit ux500_remove(struct platform_device *pdev)
4bc36fd3 MYK	145	{
	146	struct ux500_glue *glue = platform_get_drvdata(pdev);
	147
	148	platform_device_del(glue->musb);
	149	platform_device_put(glue->musb);
	150	clk_disable(glue->clk);
	151	clk_put(glue->clk);
	152	kfree(glue);
	153
	154	return 0;
	155	}
	156
	157	#ifdef CONFIG_PM
	158	static int ux500_suspend(struct device *dev)
	159	{
	160	struct ux500_glue *glue = dev_get_drvdata(dev);
	161	struct musb *musb = glue_to_musb(glue);
	162
b96d3b08	163	usb_phy_set_suspend(musb->xceiv, 1);
4bc36fd3 MYK	164	clk_disable(glue->clk);
	165
	166	return 0;
	167	}
	168
	169	static int ux500_resume(struct device *dev)
	170	{
	171	struct ux500_glue *glue = dev_get_drvdata(dev);
	172	struct musb *musb = glue_to_musb(glue);
	173	int ret;
	174
	175	ret = clk_enable(glue->clk);
	176	if (ret) {
	177	dev_err(dev, "failed to enable clock\n");
	178	return ret;
	179	}
	180
b96d3b08	181	usb_phy_set_suspend(musb->xceiv, 0);
4bc36fd3 MYK	182
	183	return 0;
	184	}
	185
	186	static const struct dev_pm_ops ux500_pm_ops = {
	187	.suspend = ux500_suspend,
	188	.resume = ux500_resume,
	189	};
	190
	191	#define DEV_PM_OPS (&ux500_pm_ops)
	192	#else
	193	#define DEV_PM_OPS NULL
	194	#endif
	195
	196	static struct platform_driver ux500_driver = {
e9e8c85e FB	197	.probe = ux500_probe,
e9e8c85e FB	198	.remove = __devexit_p(ux500_remove),
4bc36fd3 MYK	199	.driver = {
	200	.name = "musb-ux500",
	201	.pm = DEV_PM_OPS,
	202	},
	203	};
	204
	205	MODULE_DESCRIPTION("UX500 MUSB Glue Layer");
	206	MODULE_AUTHOR("Mian Yousaf Kaukab <mian.yousaf.kaukab@stericsson.com>");
	207	MODULE_LICENSE("GPL v2");
	208
	209	static int __init ux500_init(void)
	210	{
e9e8c85e	211	return platform_driver_register(&ux500_driver);
4bc36fd3	212	}
e9e8c85e	213	module_init(ux500_init);
4bc36fd3 MYK	214
	215	static void __exit ux500_exit(void)
	216	{
	217	platform_driver_unregister(&ux500_driver);
	218	}
	219	module_exit(ux500_exit);