ux500.c 5.0 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
#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)

39 40 41 42 43 44 45 46 47 48 49 50 51 52 53 54 55 56 57 58
static irqreturn_t ux500_musb_interrupt(int irq, void *__hci)
{
	unsigned long   flags;
	irqreturn_t     retval = IRQ_NONE;
	struct musb     *musb = __hci;

	spin_lock_irqsave(&musb->lock, flags);

	musb->int_usb = musb_readb(musb->mregs, MUSB_INTRUSB);
	musb->int_tx = musb_readw(musb->mregs, MUSB_INTRTX);
	musb->int_rx = musb_readw(musb->mregs, MUSB_INTRRX);

	if (musb->int_usb || musb->int_tx || musb->int_rx)
		retval = musb_interrupt(musb);

	spin_unlock_irqrestore(&musb->lock, flags);

	return retval;
}

59 60
static int ux500_musb_init(struct musb *musb)
{
61
	musb->xceiv = usb_get_phy(USB_PHY_TYPE_USB2);
62
	if (IS_ERR_OR_NULL(musb->xceiv)) {
63 64 65 66
		pr_err("HS USB OTG: no transceiver configured\n");
		return -ENODEV;
	}

67 68
	musb->isr = ux500_musb_interrupt;

69 70 71 72 73
	return 0;
}

static int ux500_musb_exit(struct musb *musb)
{
74
	usb_put_phy(musb->xceiv);
75 76 77 78 79 80 81 82 83

	return 0;
}

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

B
Bill Pemberton 已提交
84
static int ux500_probe(struct platform_device *pdev)
85 86 87 88 89 90 91 92 93 94 95 96 97
{
	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;
	}

98
	musb = platform_device_alloc("musb-hdrc", PLATFORM_DEVID_AUTO);
99 100
	if (!musb) {
		dev_err(&pdev->dev, "failed to allocate musb device\n");
101
		goto err1;
102 103 104 105 106 107
	}

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

111
	ret = clk_prepare_enable(clk);
112 113
	if (ret) {
		dev_err(&pdev->dev, "failed to enable clock\n");
114
		goto err4;
115 116 117
	}

	musb->dev.parent		= &pdev->dev;
118 119
	musb->dev.dma_mask		= pdev->dev.dma_mask;
	musb->dev.coherent_dma_mask	= pdev->dev.coherent_dma_mask;
120 121 122 123 124 125 126 127 128 129 130 131 132

	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");
133
		goto err5;
134 135 136 137 138
	}

	ret = platform_device_add_data(musb, pdata, sizeof(*pdata));
	if (ret) {
		dev_err(&pdev->dev, "failed to add platform_data\n");
139
		goto err5;
140 141 142 143 144
	}

	ret = platform_device_add(musb);
	if (ret) {
		dev_err(&pdev->dev, "failed to register musb device\n");
145
		goto err5;
146 147 148 149
	}

	return 0;

150
err5:
151
	clk_disable_unprepare(clk);
152

153
err4:
154 155
	clk_put(clk);

156
err3:
157 158 159 160 161 162 163 164 165
	platform_device_put(musb);

err1:
	kfree(glue);

err0:
	return ret;
}

B
Bill Pemberton 已提交
166
static int ux500_remove(struct platform_device *pdev)
167 168 169
{
	struct ux500_glue	*glue = platform_get_drvdata(pdev);

170
	platform_device_unregister(glue->musb);
171
	clk_disable_unprepare(glue->clk);
172 173 174 175 176 177 178 179 180 181 182 183
	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);

184
	usb_phy_set_suspend(musb->xceiv, 1);
185
	clk_disable_unprepare(glue->clk);
186 187 188 189 190 191 192 193 194 195

	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;

196
	ret = clk_prepare_enable(glue->clk);
197 198 199 200 201
	if (ret) {
		dev_err(dev, "failed to enable clock\n");
		return ret;
	}

202
	usb_phy_set_suspend(musb->xceiv, 0);
203 204 205 206 207 208 209 210 211 212 213 214 215 216 217

	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 = {
218
	.probe		= ux500_probe,
B
Bill Pemberton 已提交
219
	.remove		= ux500_remove,
220 221 222 223 224 225 226 227 228
	.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");
229
module_platform_driver(ux500_driver);