ux500.c 4.4 KB
Newer Older
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25
/*
 * 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>
26
#include <linux/err.h>
27 28 29 30 31 32 33 34 35 36 37 38 39 40
#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)
{
41
	musb->xceiv = usb_get_phy(USB_PHY_TYPE_USB2);
42
	if (IS_ERR_OR_NULL(musb->xceiv)) {
43 44 45 46 47 48 49 50 51
		pr_err("HS USB OTG: no transceiver configured\n");
		return -ENODEV;
	}

	return 0;
}

static int ux500_musb_exit(struct musb *musb)
{
52
	usb_put_phy(musb->xceiv);
53 54 55 56 57 58 59 60 61

	return 0;
}

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

62
static int __devinit ux500_probe(struct platform_device *pdev)
63 64 65 66 67 68 69 70 71 72 73 74 75
{
	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;
	}

76
	musb = platform_device_alloc("musb-hdrc", PLATFORM_DEVID_AUTO);
77 78
	if (!musb) {
		dev_err(&pdev->dev, "failed to allocate musb device\n");
79
		goto err1;
80 81 82 83 84 85
	}

	clk = clk_get(&pdev->dev, "usb");
	if (IS_ERR(clk)) {
		dev_err(&pdev->dev, "failed to get clock\n");
		ret = PTR_ERR(clk);
86
		goto err3;
87 88 89 90 91
	}

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

	musb->dev.parent		= &pdev->dev;
96 97
	musb->dev.dma_mask		= pdev->dev.dma_mask;
	musb->dev.coherent_dma_mask	= pdev->dev.coherent_dma_mask;
98 99 100 101 102 103 104 105 106 107 108 109 110

	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");
111
		goto err5;
112 113 114 115 116
	}

	ret = platform_device_add_data(musb, pdata, sizeof(*pdata));
	if (ret) {
		dev_err(&pdev->dev, "failed to add platform_data\n");
117
		goto err5;
118 119 120 121 122
	}

	ret = platform_device_add(musb);
	if (ret) {
		dev_err(&pdev->dev, "failed to register musb device\n");
123
		goto err5;
124 125 126 127
	}

	return 0;

128
err5:
129 130
	clk_disable(clk);

131
err4:
132 133
	clk_put(clk);

134
err3:
135 136 137 138 139 140 141 142 143
	platform_device_put(musb);

err1:
	kfree(glue);

err0:
	return ret;
}

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

148
	platform_device_unregister(glue->musb);
149 150 151 152 153 154 155 156 157 158 159 160 161
	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);

162
	usb_phy_set_suspend(musb->xceiv, 1);
163 164 165 166 167 168 169 170 171 172 173 174 175 176 177 178 179
	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;
	}

180
	usb_phy_set_suspend(musb->xceiv, 0);
181 182 183 184 185 186 187 188 189 190 191 192 193 194 195

	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 = {
196 197
	.probe		= ux500_probe,
	.remove		= __devexit_p(ux500_remove),
198 199 200 201 202 203 204 205 206
	.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");
207
module_platform_driver(ux500_driver);