[GitHub/mt8127/android_kernel_alcatel_ttab.git] / drivers / spi / spi-dw-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/err.h>
#include <linux/interrupt.h>
#include <linux/platform_device.h>
#include <linux/slab.h>
#include <linux/spi/spi.h>
#include <linux/scatterlist.h>
#include <linux/module.h>

#include "spi-dw.h"

#define DRIVER_NAME "dw_spi_mmio"

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

static int 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 (IS_ERR(dwsmmio->clk)) {
		ret = PTR_ERR(dwsmmio->clk);
		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 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 = {
	.probe		= dw_spi_mmio_probe,
	.remove		= dw_spi_mmio_remove,
	.driver		= {
		.name	= DRIVER_NAME,
		.owner	= THIS_MODULE,
	},
};
module_platform_driver(dw_spi_mmio_driver);

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	1	/*
ca632f55	2	* Memory-mapped interface driver for DW SPI Core
f7b6fd6d JHD	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>
50c01fc3	12	#include <linux/err.h>
f7b6fd6d JHD	13	#include <linux/interrupt.h>
f7b6fd6d JHD	14	#include <linux/platform_device.h>
5a0e3ad6	15	#include <linux/slab.h>
f7b6fd6d	16	#include <linux/spi/spi.h>
568a60ed	17	#include <linux/scatterlist.h>
d7614de4	18	#include <linux/module.h>
568a60ed	19
ca632f55	20	#include "spi-dw.h"
f7b6fd6d JHD	21
	22	#define DRIVER_NAME "dw_spi_mmio"
	23
	24	struct dw_spi_mmio {
0a4c1d7d JHD	25	struct dw_spi dws;
0a4c1d7d JHD	26	struct clk *clk;
f7b6fd6d JHD	27	};
f7b6fd6d JHD	28
fd4a319b	29	static int dw_spi_mmio_probe(struct platform_device *pdev)
f7b6fd6d JHD	30	{
	31	struct dw_spi_mmio *dwsmmio;
	32	struct dw_spi *dws;
	33	struct resource mem, ioarea;
	34	int ret;
	35
	36	dwsmmio = kzalloc(sizeof(struct dw_spi_mmio), GFP_KERNEL);
	37	if (!dwsmmio) {
	38	ret = -ENOMEM;
	39	goto err_end;
	40	}
	41
	42	dws = &dwsmmio->dws;
	43
	44	/* Get basic io resource and map it */
	45	mem = platform_get_resource(pdev, IORESOURCE_MEM, 0);
	46	if (!mem) {
	47	dev_err(&pdev->dev, "no mem resource?\n");
	48	ret = -EINVAL;
	49	goto err_kfree;
	50	}
	51
	52	ioarea = request_mem_region(mem->start, resource_size(mem),
	53	pdev->name);
	54	if (!ioarea) {
	55	dev_err(&pdev->dev, "SPI region already claimed\n");
	56	ret = -EBUSY;
	57	goto err_kfree;
	58	}
	59
	60	dws->regs = ioremap_nocache(mem->start, resource_size(mem));
	61	if (!dws->regs) {
	62	dev_err(&pdev->dev, "SPI region already mapped\n");
	63	ret = -ENOMEM;
	64	goto err_release_reg;
	65	}
	66
	67	dws->irq = platform_get_irq(pdev, 0);
	68	if (dws->irq < 0) {
	69	dev_err(&pdev->dev, "no irq resource?\n");
	70	ret = dws->irq; /* -ENXIO */
	71	goto err_unmap;
	72	}
	73
	74	dwsmmio->clk = clk_get(&pdev->dev, NULL);
50c01fc3 JI	75	if (IS_ERR(dwsmmio->clk)) {
50c01fc3 JI	76	ret = PTR_ERR(dwsmmio->clk);
f7b6fd6d JHD	77	goto err_irq;
	78	}
	79	clk_enable(dwsmmio->clk);
	80
	81	dws->parent_dev = &pdev->dev;
	82	dws->bus_num = 0;
	83	dws->num_cs = 4;
	84	dws->max_freq = clk_get_rate(dwsmmio->clk);
	85
	86	ret = dw_spi_add_host(dws);
	87	if (ret)
	88	goto err_clk;
	89
	90	platform_set_drvdata(pdev, dwsmmio);
	91	return 0;
	92
	93	err_clk:
	94	clk_disable(dwsmmio->clk);
	95	clk_put(dwsmmio->clk);
	96	dwsmmio->clk = NULL;
	97	err_irq:
	98	free_irq(dws->irq, dws);
	99	err_unmap:
	100	iounmap(dws->regs);
	101	err_release_reg:
	102	release_mem_region(mem->start, resource_size(mem));
	103	err_kfree:
	104	kfree(dwsmmio);
	105	err_end:
	106	return ret;
	107	}
	108
fd4a319b	109	static int dw_spi_mmio_remove(struct platform_device *pdev)
f7b6fd6d JHD	110	{
	111	struct dw_spi_mmio *dwsmmio = platform_get_drvdata(pdev);
	112	struct resource *mem;
	113
	114	platform_set_drvdata(pdev, NULL);
	115
	116	clk_disable(dwsmmio->clk);
	117	clk_put(dwsmmio->clk);
	118	dwsmmio->clk = NULL;
	119
	120	free_irq(dwsmmio->dws.irq, &dwsmmio->dws);
	121	dw_spi_remove_host(&dwsmmio->dws);
	122	iounmap(dwsmmio->dws.regs);
	123	kfree(dwsmmio);
	124
	125	mem = platform_get_resource(pdev, IORESOURCE_MEM, 0);
	126	release_mem_region(mem->start, resource_size(mem));
	127	return 0;
	128	}
	129
	130	static struct platform_driver dw_spi_mmio_driver = {
940ab889	131	.probe = dw_spi_mmio_probe,
fd4a319b	132	.remove = dw_spi_mmio_remove,
f7b6fd6d JHD	133	.driver = {
	134	.name = DRIVER_NAME,
	135	.owner = THIS_MODULE,
	136	},
	137	};
940ab889	138	module_platform_driver(dw_spi_mmio_driver);
f7b6fd6d JHD	139
	140	MODULE_AUTHOR("Jean-Hugues Deschenes <jean-hugues.deschenes@octasic.com>");
	141	MODULE_DESCRIPTION("Memory-mapped I/O interface driver for DW SPI Core");
	142	MODULE_LICENSE("GPL v2");