• Home
  • History
  • Annotate
  • Line#
  • Navigate
  • Raw
  • Download
  • only in /asuswrt-rt-n18u-9.0.0.4.380.2695/release/src-rt-6.x.4708/linux/linux-2.6/drivers/mmc/host/
1/*
2 * sdhci-pltfm.c Support for SDHCI platform devices
3 * Copyright (c) 2009 Intel Corporation
4 *
5 * This program is free software; you can redistribute it and/or modify
6 * it under the terms of the GNU General Public License version 2 as
7 * published by the Free Software Foundation.
8 *
9 * This program is distributed in the hope that it will be useful,
10 * but WITHOUT ANY WARRANTY; without even the implied warranty of
11 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
12 * GNU General Public License for more details.
13 *
14 * You should have received a copy of the GNU General Public License
15 * along with this program; if not, write to the Free Software
16 * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
17 */
18
19/* Supports:
20 * SDHCI platform devices
21 *
22 * Inspired by sdhci-pci.c, by Pierre Ossman
23 */
24
25#include <linux/delay.h>
26#include <linux/highmem.h>
27#include <linux/mod_devicetable.h>
28#include <linux/platform_device.h>
29
30#include <linux/mmc/host.h>
31
32#include <linux/io.h>
33#include <linux/sdhci-pltfm.h>
34
35#include "sdhci.h"
36#include "sdhci-pltfm.h"
37
38/*****************************************************************************\
39 *                                                                           *
40 * SDHCI core callbacks                                                      *
41 *                                                                           *
42\*****************************************************************************/
43
44static struct sdhci_ops sdhci_pltfm_ops = {
45};
46
47/*****************************************************************************\
48 *                                                                           *
49 * Device probing/removal                                                    *
50 *                                                                           *
51\*****************************************************************************/
52
53static int __devinit sdhci_pltfm_probe(struct platform_device *pdev)
54{
55	struct sdhci_pltfm_data *pdata = pdev->dev.platform_data;
56	const struct platform_device_id *platid = platform_get_device_id(pdev);
57	struct sdhci_host *host;
58	struct resource *iomem;
59	int ret;
60
61	if (!pdata && platid && platid->driver_data)
62		pdata = (void *)platid->driver_data;
63
64	iomem = platform_get_resource(pdev, IORESOURCE_MEM, 0);
65	if (!iomem) {
66		ret = -ENOMEM;
67		goto err;
68	}
69
70	if (resource_size(iomem) < 0x100)
71		dev_err(&pdev->dev, "Invalid iomem size. You may "
72			"experience problems.\n");
73
74	if (pdev->dev.parent)
75		host = sdhci_alloc_host(pdev->dev.parent, 0);
76	else
77		host = sdhci_alloc_host(&pdev->dev, 0);
78
79	if (IS_ERR(host)) {
80		ret = PTR_ERR(host);
81		goto err;
82	}
83
84	host->hw_name = "platform";
85	if (pdata && pdata->ops)
86		host->ops = pdata->ops;
87	else
88		host->ops = &sdhci_pltfm_ops;
89	if (pdata)
90		host->quirks = pdata->quirks;
91	host->irq = platform_get_irq(pdev, 0);
92
93	if (!request_mem_region(iomem->start, resource_size(iomem),
94		mmc_hostname(host->mmc))) {
95		dev_err(&pdev->dev, "cannot request region\n");
96		ret = -EBUSY;
97		goto err_request;
98	}
99
100	host->ioaddr = ioremap(iomem->start, resource_size(iomem));
101	if (!host->ioaddr) {
102		dev_err(&pdev->dev, "failed to remap registers\n");
103		ret = -ENOMEM;
104		goto err_remap;
105	}
106
107	if (pdata && pdata->init) {
108		ret = pdata->init(host);
109		if (ret)
110			goto err_plat_init;
111	}
112
113	ret = sdhci_add_host(host);
114	if (ret)
115		goto err_add_host;
116
117	platform_set_drvdata(pdev, host);
118
119	return 0;
120
121err_add_host:
122	if (pdata && pdata->exit)
123		pdata->exit(host);
124err_plat_init:
125	iounmap(host->ioaddr);
126err_remap:
127	release_mem_region(iomem->start, resource_size(iomem));
128err_request:
129	sdhci_free_host(host);
130err:
131	printk(KERN_ERR"Probing of sdhci-pltfm failed: %d\n", ret);
132	return ret;
133}
134
135static int __devexit sdhci_pltfm_remove(struct platform_device *pdev)
136{
137	struct sdhci_pltfm_data *pdata = pdev->dev.platform_data;
138	struct sdhci_host *host = platform_get_drvdata(pdev);
139	struct resource *iomem = platform_get_resource(pdev, IORESOURCE_MEM, 0);
140	int dead;
141	u32 scratch;
142
143	dead = 0;
144	scratch = readl(host->ioaddr + SDHCI_INT_STATUS);
145	if (scratch == (u32)-1)
146		dead = 1;
147
148	sdhci_remove_host(host, dead);
149	if (pdata && pdata->exit)
150		pdata->exit(host);
151	iounmap(host->ioaddr);
152	release_mem_region(iomem->start, resource_size(iomem));
153	sdhci_free_host(host);
154	platform_set_drvdata(pdev, NULL);
155
156	return 0;
157}
158
159static const struct platform_device_id sdhci_pltfm_ids[] = {
160	{ "sdhci", },
161#ifdef CONFIG_MMC_SDHCI_CNS3XXX
162	{ "sdhci-cns3xxx", (kernel_ulong_t)&sdhci_cns3xxx_pdata },
163#endif
164	{ },
165};
166MODULE_DEVICE_TABLE(platform, sdhci_pltfm_ids);
167
168static struct platform_driver sdhci_pltfm_driver = {
169	.driver = {
170		.name	= "sdhci",
171		.owner	= THIS_MODULE,
172	},
173	.probe		= sdhci_pltfm_probe,
174	.remove		= __devexit_p(sdhci_pltfm_remove),
175	.id_table	= sdhci_pltfm_ids,
176};
177
178/*****************************************************************************\
179 *                                                                           *
180 * Driver init/exit                                                          *
181 *                                                                           *
182\*****************************************************************************/
183
184static int __init sdhci_drv_init(void)
185{
186	return platform_driver_register(&sdhci_pltfm_driver);
187}
188
189static void __exit sdhci_drv_exit(void)
190{
191	platform_driver_unregister(&sdhci_pltfm_driver);
192}
193
194module_init(sdhci_drv_init);
195module_exit(sdhci_drv_exit);
196
197MODULE_DESCRIPTION("Secure Digital Host Controller Interface platform driver");
198MODULE_AUTHOR("Mocean Laboratories <info@mocean-labs.com>");
199MODULE_LICENSE("GPL v2");
200