[net-next-2.6.git] / drivers / mmc / host / sdhci-pltfm.c

/*
 * sdhci-pltfm.c Support for SDHCI platform devices
 * Copyright (c) 2009 Intel Corporation
 *
 * This program is free software; you can redistribute it and/or modify
 * it under the terms of the GNU General Public License version 2 as
 * published by the Free Software Foundation.
 *
 * 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.
 */

/* Supports:
 * SDHCI platform devices
 *
 * Inspired by sdhci-pci.c, by Pierre Ossman
 */

#include <linux/delay.h>
#include <linux/highmem.h>
#include <linux/mod_devicetable.h>
#include <linux/platform_device.h>

#include <linux/mmc/host.h>

#include <linux/io.h>
#include <linux/sdhci-pltfm.h>

#include "sdhci.h"
#include "sdhci-pltfm.h"

/*****************************************************************************\
 *                                                                           *
 * SDHCI core callbacks                                                      *
 *                                                                           *
\*****************************************************************************/

static struct sdhci_ops sdhci_pltfm_ops = {
};

/*****************************************************************************\
 *                                                                           *
 * Device probing/removal                                                    *
 *                                                                           *
\*****************************************************************************/

static int __devinit sdhci_pltfm_probe(struct platform_device *pdev)
{
	struct sdhci_pltfm_data *pdata = pdev->dev.platform_data;
	const struct platform_device_id *platid = platform_get_device_id(pdev);
	struct sdhci_host *host;
	struct resource *iomem;
	int ret;

	if (!pdata && platid && platid->driver_data)
		pdata = (void *)platid->driver_data;

	iomem = platform_get_resource(pdev, IORESOURCE_MEM, 0);
	if (!iomem) {
		ret = -ENOMEM;
		goto err;
	}

	if (resource_size(iomem) < 0x100)
		dev_err(&pdev->dev, "Invalid iomem size. You may "
			"experience problems.\n");

	if (pdev->dev.parent)
		host = sdhci_alloc_host(pdev->dev.parent, 0);
	else
		host = sdhci_alloc_host(&pdev->dev, 0);

	if (IS_ERR(host)) {
		ret = PTR_ERR(host);
		goto err;
	}

	host->hw_name = "platform";
	if (pdata && pdata->ops)
		host->ops = pdata->ops;
	else
		host->ops = &sdhci_pltfm_ops;
	if (pdata)
		host->quirks = pdata->quirks;
	host->irq = platform_get_irq(pdev, 0);

	if (!request_mem_region(iomem->start, resource_size(iomem),
		mmc_hostname(host->mmc))) {
		dev_err(&pdev->dev, "cannot request region\n");
		ret = -EBUSY;
		goto err_request;
	}

	host->ioaddr = ioremap(iomem->start, resource_size(iomem));
	if (!host->ioaddr) {
		dev_err(&pdev->dev, "failed to remap registers\n");
		ret = -ENOMEM;
		goto err_remap;
	}

	if (pdata && pdata->init) {
		ret = pdata->init(host);
		if (ret)
			goto err_plat_init;
	}

	ret = sdhci_add_host(host);
	if (ret)
		goto err_add_host;

	platform_set_drvdata(pdev, host);

	return 0;

err_add_host:
	if (pdata && pdata->exit)
		pdata->exit(host);
err_plat_init:
	iounmap(host->ioaddr);
err_remap:
	release_mem_region(iomem->start, resource_size(iomem));
err_request:
	sdhci_free_host(host);
err:
	printk(KERN_ERR"Probing of sdhci-pltfm failed: %d\n", ret);
	return ret;
}

static int __devexit sdhci_pltfm_remove(struct platform_device *pdev)
{
	struct sdhci_pltfm_data *pdata = pdev->dev.platform_data;
	struct sdhci_host *host = platform_get_drvdata(pdev);
	struct resource *iomem = platform_get_resource(pdev, IORESOURCE_MEM, 0);
	int dead;
	u32 scratch;

	dead = 0;
	scratch = readl(host->ioaddr + SDHCI_INT_STATUS);
	if (scratch == (u32)-1)
		dead = 1;

	sdhci_remove_host(host, dead);
	if (pdata && pdata->exit)
		pdata->exit(host);
	iounmap(host->ioaddr);
	release_mem_region(iomem->start, resource_size(iomem));
	sdhci_free_host(host);
	platform_set_drvdata(pdev, NULL);

	return 0;
}

static const struct platform_device_id sdhci_pltfm_ids[] = {
	{ "sdhci", },
#ifdef CONFIG_MMC_SDHCI_CNS3XXX
	{ "sdhci-cns3xxx", (kernel_ulong_t)&sdhci_cns3xxx_pdata },
#endif
	{ },
};
MODULE_DEVICE_TABLE(platform, sdhci_pltfm_ids);

static struct platform_driver sdhci_pltfm_driver = {
	.driver = {
		.name	= "sdhci",
		.owner	= THIS_MODULE,
	},
	.probe		= sdhci_pltfm_probe,
	.remove		= __devexit_p(sdhci_pltfm_remove),
	.id_table	= sdhci_pltfm_ids,
};

/*****************************************************************************\
 *                                                                           *
 * Driver init/exit                                                          *
 *                                                                           *
\*****************************************************************************/

static int __init sdhci_drv_init(void)
{
	return platform_driver_register(&sdhci_pltfm_driver);
}

static void __exit sdhci_drv_exit(void)
{
	platform_driver_unregister(&sdhci_pltfm_driver);
}

module_init(sdhci_drv_init);
module_exit(sdhci_drv_exit);

MODULE_DESCRIPTION("Secure Digital Host Controller Interface platform driver");
MODULE_AUTHOR("Mocean Laboratories <info@mocean-labs.com>");
MODULE_LICENSE("GPL v2");
Commit	Line	Data
a3456a2d RR	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>
515033f9	27	#include <linux/mod_devicetable.h>
a3456a2d RR	28	#include <linux/platform_device.h>
	29
	30	#include <linux/mmc/host.h>
	31
	32	#include <linux/io.h>
a7626b7a	33	#include <linux/sdhci-pltfm.h>
a3456a2d RR	34
a3456a2d RR	35	#include "sdhci.h"
515033f9	36	#include "sdhci-pltfm.h"
a3456a2d RR	37
	38	/*****************************************************************************\
	39	* *
	40	* SDHCI core callbacks *
	41	* *
	42	\*****************************************************************************/
	43
	44	static struct sdhci_ops sdhci_pltfm_ops = {
	45	};
	46
	47	/*****************************************************************************\
	48	* *
	49	* Device probing/removal *
	50	* *
	51	\*****************************************************************************/
	52
	53	static int __devinit sdhci_pltfm_probe(struct platform_device *pdev)
	54	{
a7626b7a	55	struct sdhci_pltfm_data *pdata = pdev->dev.platform_data;
515033f9	56	const struct platform_device_id *platid = platform_get_device_id(pdev);
a3456a2d RR	57	struct sdhci_host *host;
	58	struct resource *iomem;
	59	int ret;
	60
515033f9 AV	61	if (!pdata && platid && platid->driver_data)
	62	pdata = (void *)platid->driver_data;
	63
a3456a2d RR	64	iomem = platform_get_resource(pdev, IORESOURCE_MEM, 0);
	65	if (!iomem) {
	66	ret = -ENOMEM;
	67	goto err;
	68	}
	69
e632c45a	70	if (resource_size(iomem) < 0x100)
a3456a2d RR	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";
a7626b7a AV	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;
a3456a2d RR	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
a7626b7a AV	107	if (pdata && pdata->init) {
	108	ret = pdata->init(host);
	109	if (ret)
	110	goto err_plat_init;
	111	}
	112
a3456a2d RR	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
	121	err_add_host:
a7626b7a AV	122	if (pdata && pdata->exit)
	123	pdata->exit(host);
	124	err_plat_init:
a3456a2d RR	125	iounmap(host->ioaddr);
	126	err_remap:
	127	release_mem_region(iomem->start, resource_size(iomem));
	128	err_request:
	129	sdhci_free_host(host);
	130	err:
	131	printk(KERN_ERR"Probing of sdhci-pltfm failed: %d\n", ret);
	132	return ret;
	133	}
	134
	135	static int __devexit sdhci_pltfm_remove(struct platform_device *pdev)
	136	{
a7626b7a	137	struct sdhci_pltfm_data *pdata = pdev->dev.platform_data;
a3456a2d RR	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);
a7626b7a AV	149	if (pdata && pdata->exit)
a7626b7a AV	150	pdata->exit(host);
a3456a2d RR	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
515033f9 AV	159	static const struct platform_device_id sdhci_pltfm_ids[] = {
515033f9 AV	160	{ "sdhci", },
20b1597b AV	161	#ifdef CONFIG_MMC_SDHCI_CNS3XXX
	162	{ "sdhci-cns3xxx", (kernel_ulong_t)&sdhci_cns3xxx_pdata },
	163	#endif
515033f9 AV	164	{ },
	165	};
	166	MODULE_DEVICE_TABLE(platform, sdhci_pltfm_ids);
	167
a3456a2d RR	168	static 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),
515033f9	175	.id_table = sdhci_pltfm_ids,
a3456a2d RR	176	};
	177
	178	/*****************************************************************************\
	179	* *
	180	* Driver init/exit *
	181	* *
	182	\*****************************************************************************/
	183
	184	static int __init sdhci_drv_init(void)
	185	{
	186	return platform_driver_register(&sdhci_pltfm_driver);
	187	}
	188
	189	static void __exit sdhci_drv_exit(void)
	190	{
	191	platform_driver_unregister(&sdhci_pltfm_driver);
	192	}
	193
	194	module_init(sdhci_drv_init);
	195	module_exit(sdhci_drv_exit);
	196
	197	MODULE_DESCRIPTION("Secure Digital Host Controller Interface platform driver");
	198	MODULE_AUTHOR("Mocean Laboratories <info@mocean-labs.com>");
	199	MODULE_LICENSE("GPL v2");