[net-next-2.6.git] / drivers / spi / dw_spi_mmio.c

/*
 * dw_spi_mmio.c - Memory-mapped interface driver for DW SPI Core
 *
 * Copyright (c) 2010, Octasic semiconductor.
 *
 * This program is free software; you can redistribute it and/or modify it
 * under the terms and conditions of the GNU General Public License,
 * version 2, as published by the Free Software Foundation.
 */

#include <linux/clk.h>
#include <linux/interrupt.h>
#include <linux/platform_device.h>
#include <linux/slab.h>
#include <linux/spi/dw_spi.h>
#include <linux/spi/spi.h>

#define DRIVER_NAME "dw_spi_mmio"

struct dw_spi_mmio {
	struct dw_spi  dws;
	struct clk     *clk;
};

static int __devinit dw_spi_mmio_probe(struct platform_device *pdev)
{
	struct dw_spi_mmio *dwsmmio;
	struct dw_spi *dws;
	struct resource *mem, *ioarea;
	int ret;

	dwsmmio = kzalloc(sizeof(struct dw_spi_mmio), GFP_KERNEL);
	if (!dwsmmio) {
		ret = -ENOMEM;
		goto err_end;
	}

	dws = &dwsmmio->dws;

	/* Get basic io resource and map it */
	mem = platform_get_resource(pdev, IORESOURCE_MEM, 0);
	if (!mem) {
		dev_err(&pdev->dev, "no mem resource?\n");
		ret = -EINVAL;
		goto err_kfree;
	}

	ioarea = request_mem_region(mem->start, resource_size(mem),
			pdev->name);
	if (!ioarea) {
		dev_err(&pdev->dev, "SPI region already claimed\n");
		ret = -EBUSY;
		goto err_kfree;
	}

	dws->regs = ioremap_nocache(mem->start, resource_size(mem));
	if (!dws->regs) {
		dev_err(&pdev->dev, "SPI region already mapped\n");
		ret = -ENOMEM;
		goto err_release_reg;
	}

	dws->irq = platform_get_irq(pdev, 0);
	if (dws->irq < 0) {
		dev_err(&pdev->dev, "no irq resource?\n");
		ret = dws->irq; /* -ENXIO */
		goto err_unmap;
	}

	dwsmmio->clk = clk_get(&pdev->dev, NULL);
	if (!dwsmmio->clk) {
		ret = -ENODEV;
		goto err_irq;
	}
	clk_enable(dwsmmio->clk);

	dws->parent_dev = &pdev->dev;
	dws->bus_num = 0;
	dws->num_cs = 4;
	dws->max_freq = clk_get_rate(dwsmmio->clk);

	ret = dw_spi_add_host(dws);
	if (ret)
		goto err_clk;

	platform_set_drvdata(pdev, dwsmmio);
	return 0;

err_clk:
	clk_disable(dwsmmio->clk);
	clk_put(dwsmmio->clk);
	dwsmmio->clk = NULL;
err_irq:
	free_irq(dws->irq, dws);
err_unmap:
	iounmap(dws->regs);
err_release_reg:
	release_mem_region(mem->start, resource_size(mem));
err_kfree:
	kfree(dwsmmio);
err_end:
	return ret;
}

static int __devexit dw_spi_mmio_remove(struct platform_device *pdev)
{
	struct dw_spi_mmio *dwsmmio = platform_get_drvdata(pdev);
	struct resource *mem;

	platform_set_drvdata(pdev, NULL);

	clk_disable(dwsmmio->clk);
	clk_put(dwsmmio->clk);
	dwsmmio->clk = NULL;

	free_irq(dwsmmio->dws.irq, &dwsmmio->dws);
	dw_spi_remove_host(&dwsmmio->dws);
	iounmap(dwsmmio->dws.regs);
	kfree(dwsmmio);

	mem = platform_get_resource(pdev, IORESOURCE_MEM, 0);
	release_mem_region(mem->start, resource_size(mem));
	return 0;
}

static struct platform_driver dw_spi_mmio_driver = {
	.remove		= __devexit_p(dw_spi_mmio_remove),
	.driver		= {
		.name	= DRIVER_NAME,
		.owner	= THIS_MODULE,
	},
};

static int __init dw_spi_mmio_init(void)
{
	return platform_driver_probe(&dw_spi_mmio_driver, dw_spi_mmio_probe);
}
module_init(dw_spi_mmio_init);

static void __exit dw_spi_mmio_exit(void)
{
	platform_driver_unregister(&dw_spi_mmio_driver);
}
module_exit(dw_spi_mmio_exit);

MODULE_AUTHOR("Jean-Hugues Deschenes <jean-hugues.deschenes@octasic.com>");
MODULE_DESCRIPTION("Memory-mapped I/O interface driver for DW SPI Core");
MODULE_LICENSE("GPL v2");
Commit	Line	Data
f7b6fd6d JHD	1	/*
	2	* dw_spi_mmio.c - Memory-mapped interface driver for DW SPI Core
	3	*
	4	* Copyright (c) 2010, Octasic semiconductor.
	5	*
	6	* This program is free software; you can redistribute it and/or modify it
	7	* under the terms and conditions of the GNU General Public License,
	8	* version 2, as published by the Free Software Foundation.
	9	*/
	10
	11	#include <linux/clk.h>
	12	#include <linux/interrupt.h>
	13	#include <linux/platform_device.h>
5a0e3ad6	14	#include <linux/slab.h>
f7b6fd6d JHD	15	#include <linux/spi/dw_spi.h>
	16	#include <linux/spi/spi.h>
	17
	18	#define DRIVER_NAME "dw_spi_mmio"
	19
	20	struct dw_spi_mmio {
0a4c1d7d JHD	21	struct dw_spi dws;
0a4c1d7d JHD	22	struct clk *clk;
f7b6fd6d JHD	23	};
	24
	25	static int __devinit dw_spi_mmio_probe(struct platform_device *pdev)
	26	{
	27	struct dw_spi_mmio *dwsmmio;
	28	struct dw_spi *dws;
	29	struct resource mem, ioarea;
	30	int ret;
	31
	32	dwsmmio = kzalloc(sizeof(struct dw_spi_mmio), GFP_KERNEL);
	33	if (!dwsmmio) {
	34	ret = -ENOMEM;
	35	goto err_end;
	36	}
	37
	38	dws = &dwsmmio->dws;
	39
	40	/* Get basic io resource and map it */
	41	mem = platform_get_resource(pdev, IORESOURCE_MEM, 0);
	42	if (!mem) {
	43	dev_err(&pdev->dev, "no mem resource?\n");
	44	ret = -EINVAL;
	45	goto err_kfree;
	46	}
	47
	48	ioarea = request_mem_region(mem->start, resource_size(mem),
	49	pdev->name);
	50	if (!ioarea) {
	51	dev_err(&pdev->dev, "SPI region already claimed\n");
	52	ret = -EBUSY;
	53	goto err_kfree;
	54	}
	55
	56	dws->regs = ioremap_nocache(mem->start, resource_size(mem));
	57	if (!dws->regs) {
	58	dev_err(&pdev->dev, "SPI region already mapped\n");
	59	ret = -ENOMEM;
	60	goto err_release_reg;
	61	}
	62
	63	dws->irq = platform_get_irq(pdev, 0);
	64	if (dws->irq < 0) {
	65	dev_err(&pdev->dev, "no irq resource?\n");
	66	ret = dws->irq; /* -ENXIO */
	67	goto err_unmap;
	68	}
	69
	70	dwsmmio->clk = clk_get(&pdev->dev, NULL);
	71	if (!dwsmmio->clk) {
	72	ret = -ENODEV;
	73	goto err_irq;
	74	}
	75	clk_enable(dwsmmio->clk);
	76
	77	dws->parent_dev = &pdev->dev;
	78	dws->bus_num = 0;
	79	dws->num_cs = 4;
	80	dws->max_freq = clk_get_rate(dwsmmio->clk);
	81
	82	ret = dw_spi_add_host(dws);
	83	if (ret)
	84	goto err_clk;
	85
	86	platform_set_drvdata(pdev, dwsmmio);
87	return 0;
88
89	err_clk:
90	clk_disable(dwsmmio->clk);
91	clk_put(dwsmmio->clk);
92	dwsmmio->clk = NULL;
93	err_irq:
94	free_irq(dws->irq, dws);
95	err_unmap:
96	iounmap(dws->regs);
97	err_release_reg:
98	release_mem_region(mem->start, resource_size(mem));
99	err_kfree:
100	kfree(dwsmmio);
101	err_end:
102	return ret;
103	}
104
105	static int __devexit dw_spi_mmio_remove(struct platform_device *pdev)
106	{
107	struct dw_spi_mmio *dwsmmio = platform_get_drvdata(pdev);
108	struct resource *mem;
109
110	platform_set_drvdata(pdev, NULL);
111
112	clk_disable(dwsmmio->clk);
113	clk_put(dwsmmio->clk);
114	dwsmmio->clk = NULL;
115
116	free_irq(dwsmmio->dws.irq, &dwsmmio->dws);
117	dw_spi_remove_host(&dwsmmio->dws);
118	iounmap(dwsmmio->dws.regs);
119	kfree(dwsmmio);
120
121	mem = platform_get_resource(pdev, IORESOURCE_MEM, 0);
122	release_mem_region(mem->start, resource_size(mem));
123	return 0;
124	}
125
126	static struct platform_driver dw_spi_mmio_driver = {
127	.remove = __devexit_p(dw_spi_mmio_remove),
128	.driver = {
129	.name = DRIVER_NAME,
130	.owner = THIS_MODULE,
131	},
132	};
133
134	static int __init dw_spi_mmio_init(void)
135	{
136	return platform_driver_probe(&dw_spi_mmio_driver, dw_spi_mmio_probe);
137	}
0a4c1d7d	138	module_init(dw_spi_mmio_init);
f7b6fd6d JHD	139
	140	static void __exit dw_spi_mmio_exit(void)
	141	{
	142	platform_driver_unregister(&dw_spi_mmio_driver);
	143	}
f7b6fd6d JHD	144	module_exit(dw_spi_mmio_exit);
	145
	146	MODULE_AUTHOR("Jean-Hugues Deschenes <jean-hugues.deschenes@octasic.com>");
	147	MODULE_DESCRIPTION("Memory-mapped I/O interface driver for DW SPI Core");
	148	MODULE_LICENSE("GPL v2");