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

/* linux/drivers/spi/spi_s3c24xx.c
 *
 * Copyright (c) 2006 Ben Dooks
 * Copyright (c) 2006 Simtec Electronics
 *	Ben Dooks <ben@simtec.co.uk>
 *
 * 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.
 *
*/

#include <linux/init.h>
#include <linux/spinlock.h>
#include <linux/workqueue.h>
#include <linux/interrupt.h>
#include <linux/delay.h>
#include <linux/errno.h>
#include <linux/err.h>
#include <linux/clk.h>
#include <linux/platform_device.h>

#include <linux/spi/spi.h>
#include <linux/spi/spi_bitbang.h>

#include <asm/io.h>
#include <asm/dma.h>
#include <asm/hardware.h>

#include <asm/arch/regs-gpio.h>
#include <asm/plat-s3c24xx/regs-spi.h>
#include <asm/arch/spi.h>

struct s3c24xx_spi {
	/* bitbang has to be first */
	struct spi_bitbang	 bitbang;
	struct completion	 done;

	void __iomem		*regs;
	int			 irq;
	int			 len;
	int			 count;

	void			(*set_cs)(struct s3c2410_spi_info *spi,
					  int cs, int pol);

	/* data buffers */
	const unsigned char	*tx;
	unsigned char		*rx;

	struct clk		*clk;
	struct resource		*ioarea;
	struct spi_master	*master;
	struct spi_device	*curdev;
	struct device		*dev;
	struct s3c2410_spi_info *pdata;
};

#define SPCON_DEFAULT (S3C2410_SPCON_MSTR | S3C2410_SPCON_SMOD_INT)
#define SPPIN_DEFAULT (S3C2410_SPPIN_KEEP)

static inline struct s3c24xx_spi *to_hw(struct spi_device *sdev)
{
	return spi_master_get_devdata(sdev->master);
}

static void s3c24xx_spi_gpiocs(struct s3c2410_spi_info *spi, int cs, int pol)
{
	s3c2410_gpio_setpin(spi->pin_cs, pol);
}

static void s3c24xx_spi_chipsel(struct spi_device *spi, int value)
{
	struct s3c24xx_spi *hw = to_hw(spi);
	unsigned int cspol = spi->mode & SPI_CS_HIGH ? 1 : 0;
	unsigned int spcon;

	switch (value) {
	case BITBANG_CS_INACTIVE:
		hw->set_cs(hw->pdata, spi->chip_select, cspol^1);
		break;

	case BITBANG_CS_ACTIVE:
		spcon = readb(hw->regs + S3C2410_SPCON);

		if (spi->mode & SPI_CPHA)
			spcon |= S3C2410_SPCON_CPHA_FMTB;
		else
			spcon &= ~S3C2410_SPCON_CPHA_FMTB;

		if (spi->mode & SPI_CPOL)
			spcon |= S3C2410_SPCON_CPOL_HIGH;
		else
			spcon &= ~S3C2410_SPCON_CPOL_HIGH;

		spcon |= S3C2410_SPCON_ENSCK;

		/* write new configration */

		writeb(spcon, hw->regs + S3C2410_SPCON);
		hw->set_cs(hw->pdata, spi->chip_select, cspol);

		break;
	}
}

static int s3c24xx_spi_setupxfer(struct spi_device *spi,
				 struct spi_transfer *t)
{
	struct s3c24xx_spi *hw = to_hw(spi);
	unsigned int bpw;
	unsigned int hz;
	unsigned int div;

	bpw = t ? t->bits_per_word : spi->bits_per_word;
	hz  = t ? t->speed_hz : spi->max_speed_hz;

	if (bpw != 8) {
		dev_err(&spi->dev, "invalid bits-per-word (%d)\n", bpw);
		return -EINVAL;
	}

	div = clk_get_rate(hw->clk) / hz;

	/* is clk = pclk / (2 * (pre+1)), or is it
	 *    clk = (pclk * 2) / ( pre + 1) */

	div = (div / 2) - 1;

	if (div < 0)
		div = 1;

	if (div > 255)
		div = 255;

	dev_dbg(&spi->dev, "setting pre-scaler to %d (hz %d)\n", div, hz);
	writeb(div, hw->regs + S3C2410_SPPRE);

	spin_lock(&hw->bitbang.lock);
	if (!hw->bitbang.busy) {
		hw->bitbang.chipselect(spi, BITBANG_CS_INACTIVE);
		/* need to ndelay for 0.5 clocktick ? */
	}
	spin_unlock(&hw->bitbang.lock);

	return 0;
}

/* the spi->mode bits understood by this driver: */
#define MODEBITS (SPI_CPOL | SPI_CPHA | SPI_CS_HIGH)

static int s3c24xx_spi_setup(struct spi_device *spi)
{
	int ret;

	if (!spi->bits_per_word)
		spi->bits_per_word = 8;

	if (spi->mode & ~MODEBITS) {
		dev_dbg(&spi->dev, "setup: unsupported mode bits %x\n",
			spi->mode & ~MODEBITS);
		return -EINVAL;
	}

	ret = s3c24xx_spi_setupxfer(spi, NULL);
	if (ret < 0) {
		dev_err(&spi->dev, "setupxfer returned %d\n", ret);
		return ret;
	}

	dev_dbg(&spi->dev, "%s: mode %d, %u bpw, %d hz\n",
		__FUNCTION__, spi->mode, spi->bits_per_word,
		spi->max_speed_hz);

	return 0;
}

static inline unsigned int hw_txbyte(struct s3c24xx_spi *hw, int count)
{
	return hw->tx ? hw->tx[count] : 0;
}

static int s3c24xx_spi_txrx(struct spi_device *spi, struct spi_transfer *t)
{
	struct s3c24xx_spi *hw = to_hw(spi);

	dev_dbg(&spi->dev, "txrx: tx %p, rx %p, len %d\n",
		t->tx_buf, t->rx_buf, t->len);

	hw->tx = t->tx_buf;
	hw->rx = t->rx_buf;
	hw->len = t->len;
	hw->count = 0;

	init_completion(&hw->done);

	/* send the first byte */
	writeb(hw_txbyte(hw, 0), hw->regs + S3C2410_SPTDAT);

	wait_for_completion(&hw->done);

	return hw->count;
}

static irqreturn_t s3c24xx_spi_irq(int irq, void *dev)
{
	struct s3c24xx_spi *hw = dev;
	unsigned int spsta = readb(hw->regs + S3C2410_SPSTA);
	unsigned int count = hw->count;

	if (spsta & S3C2410_SPSTA_DCOL) {
		dev_dbg(hw->dev, "data-collision\n");
		complete(&hw->done);
		goto irq_done;
	}

	if (!(spsta & S3C2410_SPSTA_READY)) {
		dev_dbg(hw->dev, "spi not ready for tx?\n");
		complete(&hw->done);
		goto irq_done;
	}

	hw->count++;

	if (hw->rx)
		hw->rx[count] = readb(hw->regs + S3C2410_SPRDAT);

	count++;

	if (count < hw->len)
		writeb(hw_txbyte(hw, count), hw->regs + S3C2410_SPTDAT);
	else
		complete(&hw->done);

 irq_done:
	return IRQ_HANDLED;
}

static int __init s3c24xx_spi_probe(struct platform_device *pdev)
{
	struct s3c2410_spi_info *pdata;
	struct s3c24xx_spi *hw;
	struct spi_master *master;
	struct resource *res;
	int err = 0;

	master = spi_alloc_master(&pdev->dev, sizeof(struct s3c24xx_spi));
	if (master == NULL) {
		dev_err(&pdev->dev, "No memory for spi_master\n");
		err = -ENOMEM;
		goto err_nomem;
	}

	hw = spi_master_get_devdata(master);
	memset(hw, 0, sizeof(struct s3c24xx_spi));

	hw->master = spi_master_get(master);
	hw->pdata = pdata = pdev->dev.platform_data;
	hw->dev = &pdev->dev;

	if (pdata == NULL) {
		dev_err(&pdev->dev, "No platform data supplied\n");
		err = -ENOENT;
		goto err_no_pdata;
	}

	platform_set_drvdata(pdev, hw);
	init_completion(&hw->done);

	/* setup the state for the bitbang driver */

	hw->bitbang.master         = hw->master;
	hw->bitbang.setup_transfer = s3c24xx_spi_setupxfer;
	hw->bitbang.chipselect     = s3c24xx_spi_chipsel;
	hw->bitbang.txrx_bufs      = s3c24xx_spi_txrx;
	hw->bitbang.master->setup  = s3c24xx_spi_setup;

	dev_dbg(hw->dev, "bitbang at %p\n", &hw->bitbang);

	/* find and map our resources */

	res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
	if (res == NULL) {
		dev_err(&pdev->dev, "Cannot get IORESOURCE_MEM\n");
		err = -ENOENT;
		goto err_no_iores;
	}

	hw->ioarea = request_mem_region(res->start, (res->end - res->start)+1,
					pdev->name);

	if (hw->ioarea == NULL) {
		dev_err(&pdev->dev, "Cannot reserve region\n");
		err = -ENXIO;
		goto err_no_iores;
	}

	hw->regs = ioremap(res->start, (res->end - res->start)+1);
	if (hw->regs == NULL) {
		dev_err(&pdev->dev, "Cannot map IO\n");
		err = -ENXIO;
		goto err_no_iomap;
	}

	hw->irq = platform_get_irq(pdev, 0);
	if (hw->irq < 0) {
		dev_err(&pdev->dev, "No IRQ specified\n");
		err = -ENOENT;
		goto err_no_irq;
	}

	err = request_irq(hw->irq, s3c24xx_spi_irq, 0, pdev->name, hw);
	if (err) {
		dev_err(&pdev->dev, "Cannot claim IRQ\n");
		goto err_no_irq;
	}

	hw->clk = clk_get(&pdev->dev, "spi");
	if (IS_ERR(hw->clk)) {
		dev_err(&pdev->dev, "No clock for device\n");
		err = PTR_ERR(hw->clk);
		goto err_no_clk;
	}

	/* for the moment, permanently enable the clock */

	clk_enable(hw->clk);

	/* program defaults into the registers */

	writeb(0xff, hw->regs + S3C2410_SPPRE);
	writeb(SPPIN_DEFAULT, hw->regs + S3C2410_SPPIN);
	writeb(SPCON_DEFAULT, hw->regs + S3C2410_SPCON);

	/* setup any gpio we can */

	if (!pdata->set_cs) {
		hw->set_cs = s3c24xx_spi_gpiocs;

		s3c2410_gpio_setpin(pdata->pin_cs, 1);
		s3c2410_gpio_cfgpin(pdata->pin_cs, S3C2410_GPIO_OUTPUT);
	} else
		hw->set_cs = pdata->set_cs;

	/* register our spi controller */

	err = spi_bitbang_start(&hw->bitbang);
	if (err) {
		dev_err(&pdev->dev, "Failed to register SPI master\n");
		goto err_register;
	}

	return 0;

 err_register:
	clk_disable(hw->clk);
	clk_put(hw->clk);

 err_no_clk:
	free_irq(hw->irq, hw);

 err_no_irq:
	iounmap(hw->regs);

 err_no_iomap:
	release_resource(hw->ioarea);
	kfree(hw->ioarea);

 err_no_iores:
 err_no_pdata:
	spi_master_put(hw->master);;

 err_nomem:
	return err;
}

static int __exit s3c24xx_spi_remove(struct platform_device *dev)
{
	struct s3c24xx_spi *hw = platform_get_drvdata(dev);

	platform_set_drvdata(dev, NULL);

	spi_unregister_master(hw->master);

	clk_disable(hw->clk);
	clk_put(hw->clk);

	free_irq(hw->irq, hw);
	iounmap(hw->regs);

	release_resource(hw->ioarea);
	kfree(hw->ioarea);

	spi_master_put(hw->master);
	return 0;
}


#ifdef CONFIG_PM

static int s3c24xx_spi_suspend(struct platform_device *pdev, pm_message_t msg)
{
	struct s3c24xx_spi *hw = platform_get_drvdata(pdev);

	clk_disable(hw->clk);
	return 0;
}

static int s3c24xx_spi_resume(struct platform_device *pdev)
{
	struct s3c24xx_spi *hw = platform_get_drvdata(pdev);

	clk_enable(hw->clk);
	return 0;
}

#else
#define s3c24xx_spi_suspend NULL
#define s3c24xx_spi_resume  NULL
#endif

MODULE_ALIAS("platform:s3c2410-spi");
static struct platform_driver s3c24xx_spidrv = {
	.remove		= __exit_p(s3c24xx_spi_remove),
	.suspend	= s3c24xx_spi_suspend,
	.resume		= s3c24xx_spi_resume,
	.driver		= {
		.name	= "s3c2410-spi",
		.owner	= THIS_MODULE,
	},
};

static int __init s3c24xx_spi_init(void)
{
        return platform_driver_probe(&s3c24xx_spidrv, s3c24xx_spi_probe);
}

static void __exit s3c24xx_spi_exit(void)
{
        platform_driver_unregister(&s3c24xx_spidrv);
}

module_init(s3c24xx_spi_init);
module_exit(s3c24xx_spi_exit);

MODULE_DESCRIPTION("S3C24XX SPI Driver");
MODULE_AUTHOR("Ben Dooks, <ben@simtec.co.uk>");
MODULE_LICENSE("GPL");
Commit	Line	Data
7fba5340 BD	1	/* linux/drivers/spi/spi_s3c24xx.c
	2	*
	3	* Copyright (c) 2006 Ben Dooks
	4	* Copyright (c) 2006 Simtec Electronics
	5	* Ben Dooks <ben@simtec.co.uk>
	6	*
	7	* This program is free software; you can redistribute it and/or modify
	8	* it under the terms of the GNU General Public License version 2 as
	9	* published by the Free Software Foundation.
	10	*
	11	*/
	12
7fba5340 BD	13	#include <linux/init.h>
	14	#include <linux/spinlock.h>
	15	#include <linux/workqueue.h>
	16	#include <linux/interrupt.h>
	17	#include <linux/delay.h>
	18	#include <linux/errno.h>
	19	#include <linux/err.h>
	20	#include <linux/clk.h>
	21	#include <linux/platform_device.h>
	22
	23	#include <linux/spi/spi.h>
	24	#include <linux/spi/spi_bitbang.h>
	25
	26	#include <asm/io.h>
	27	#include <asm/dma.h>
	28	#include <asm/hardware.h>
	29
	30	#include <asm/arch/regs-gpio.h>
47572b84	31	#include <asm/plat-s3c24xx/regs-spi.h>
7fba5340 BD	32	#include <asm/arch/spi.h>
	33
	34	struct s3c24xx_spi {
	35	/* bitbang has to be first */
	36	struct spi_bitbang bitbang;
	37	struct completion done;
	38
	39	void __iomem *regs;
	40	int irq;
	41	int len;
	42	int count;
	43
6c912a3d	44	void (set_cs)(struct s3c2410_spi_info spi,
8736b927 BD	45	int cs, int pol);
8736b927 BD	46
7fba5340 BD	47	/* data buffers */
	48	const unsigned char *tx;
	49	unsigned char *rx;
	50
	51	struct clk *clk;
	52	struct resource *ioarea;
	53	struct spi_master *master;
	54	struct spi_device *curdev;
	55	struct device *dev;
	56	struct s3c2410_spi_info *pdata;
	57	};
	58
	59	#define SPCON_DEFAULT (S3C2410_SPCON_MSTR \| S3C2410_SPCON_SMOD_INT)
	60	#define SPPIN_DEFAULT (S3C2410_SPPIN_KEEP)
	61
	62	static inline struct s3c24xx_spi to_hw(struct spi_device sdev)
	63	{
	64	return spi_master_get_devdata(sdev->master);
	65	}
	66
8736b927 BD	67	static void s3c24xx_spi_gpiocs(struct s3c2410_spi_info *spi, int cs, int pol)
	68	{
	69	s3c2410_gpio_setpin(spi->pin_cs, pol);
	70	}
	71
7fba5340 BD	72	static void s3c24xx_spi_chipsel(struct spi_device *spi, int value)
	73	{
	74	struct s3c24xx_spi *hw = to_hw(spi);
	75	unsigned int cspol = spi->mode & SPI_CS_HIGH ? 1 : 0;
	76	unsigned int spcon;
	77
	78	switch (value) {
	79	case BITBANG_CS_INACTIVE:
3d2c5b41	80	hw->set_cs(hw->pdata, spi->chip_select, cspol^1);
7fba5340 BD	81	break;
	82
	83	case BITBANG_CS_ACTIVE:
	84	spcon = readb(hw->regs + S3C2410_SPCON);
	85
	86	if (spi->mode & SPI_CPHA)
	87	spcon \|= S3C2410_SPCON_CPHA_FMTB;
	88	else
	89	spcon &= ~S3C2410_SPCON_CPHA_FMTB;
	90
	91	if (spi->mode & SPI_CPOL)
	92	spcon \|= S3C2410_SPCON_CPOL_HIGH;
	93	else
	94	spcon &= ~S3C2410_SPCON_CPOL_HIGH;
	95
	96	spcon \|= S3C2410_SPCON_ENSCK;
	97
	98	/* write new configration */
	99
	100	writeb(spcon, hw->regs + S3C2410_SPCON);
3d2c5b41	101	hw->set_cs(hw->pdata, spi->chip_select, cspol);
7fba5340 BD	102
7fba5340 BD	103	break;
7fba5340 BD	104	}
	105	}
	106
	107	static int s3c24xx_spi_setupxfer(struct spi_device *spi,
	108	struct spi_transfer *t)
	109	{
	110	struct s3c24xx_spi *hw = to_hw(spi);
	111	unsigned int bpw;
	112	unsigned int hz;
	113	unsigned int div;
	114
	115	bpw = t ? t->bits_per_word : spi->bits_per_word;
	116	hz = t ? t->speed_hz : spi->max_speed_hz;
	117
	118	if (bpw != 8) {
	119	dev_err(&spi->dev, "invalid bits-per-word (%d)\n", bpw);
	120	return -EINVAL;
	121	}
	122
	123	div = clk_get_rate(hw->clk) / hz;
	124
	125	/* is clk = pclk / (2 * (pre+1)), or is it
	126	* clk = (pclk * 2) / ( pre + 1) */
	127
	128	div = (div / 2) - 1;
	129
	130	if (div < 0)
	131	div = 1;
	132
	133	if (div > 255)
	134	div = 255;
	135
	136	dev_dbg(&spi->dev, "setting pre-scaler to %d (hz %d)\n", div, hz);
	137	writeb(div, hw->regs + S3C2410_SPPRE);
	138
	139	spin_lock(&hw->bitbang.lock);
	140	if (!hw->bitbang.busy) {
	141	hw->bitbang.chipselect(spi, BITBANG_CS_INACTIVE);
	142	/* need to ndelay for 0.5 clocktick ? */
	143	}
	144	spin_unlock(&hw->bitbang.lock);
	145
	146	return 0;
	147	}
	148
dccd573b DB	149	/* the spi->mode bits understood by this driver: */
	150	#define MODEBITS (SPI_CPOL \| SPI_CPHA \| SPI_CS_HIGH)
	151
7fba5340 BD	152	static int s3c24xx_spi_setup(struct spi_device *spi)
	153	{
	154	int ret;
	155
	156	if (!spi->bits_per_word)
	157	spi->bits_per_word = 8;
	158
dccd573b DB	159	if (spi->mode & ~MODEBITS) {
	160	dev_dbg(&spi->dev, "setup: unsupported mode bits %x\n",
	161	spi->mode & ~MODEBITS);
7fba5340	162	return -EINVAL;
dccd573b	163	}
7fba5340 BD	164
	165	ret = s3c24xx_spi_setupxfer(spi, NULL);
	166	if (ret < 0) {
	167	dev_err(&spi->dev, "setupxfer returned %d\n", ret);
	168	return ret;
	169	}
	170
	171	dev_dbg(&spi->dev, "%s: mode %d, %u bpw, %d hz\n",
	172	__FUNCTION__, spi->mode, spi->bits_per_word,
	173	spi->max_speed_hz);
	174
	175	return 0;
	176	}
	177
	178	static inline unsigned int hw_txbyte(struct s3c24xx_spi *hw, int count)
	179	{
4b1badf5	180	return hw->tx ? hw->tx[count] : 0;
7fba5340 BD	181	}
	182
	183	static int s3c24xx_spi_txrx(struct spi_device spi, struct spi_transfer t)
	184	{
	185	struct s3c24xx_spi *hw = to_hw(spi);
	186
	187	dev_dbg(&spi->dev, "txrx: tx %p, rx %p, len %d\n",
	188	t->tx_buf, t->rx_buf, t->len);
	189
	190	hw->tx = t->tx_buf;
	191	hw->rx = t->rx_buf;
	192	hw->len = t->len;
	193	hw->count = 0;
	194
4bb5eba0 BD	195	init_completion(&hw->done);
4bb5eba0 BD	196
7fba5340 BD	197	/* send the first byte */
7fba5340 BD	198	writeb(hw_txbyte(hw, 0), hw->regs + S3C2410_SPTDAT);
4bb5eba0	199
7fba5340 BD	200	wait_for_completion(&hw->done);
	201
	202	return hw->count;
	203	}
	204
7d12e780	205	static irqreturn_t s3c24xx_spi_irq(int irq, void *dev)
7fba5340 BD	206	{
	207	struct s3c24xx_spi *hw = dev;
	208	unsigned int spsta = readb(hw->regs + S3C2410_SPSTA);
	209	unsigned int count = hw->count;
	210
	211	if (spsta & S3C2410_SPSTA_DCOL) {
	212	dev_dbg(hw->dev, "data-collision\n");
	213	complete(&hw->done);
	214	goto irq_done;
	215	}
	216
	217	if (!(spsta & S3C2410_SPSTA_READY)) {
	218	dev_dbg(hw->dev, "spi not ready for tx?\n");
	219	complete(&hw->done);
	220	goto irq_done;
	221	}
	222
	223	hw->count++;
	224
	225	if (hw->rx)
	226	hw->rx[count] = readb(hw->regs + S3C2410_SPRDAT);
	227
	228	count++;
	229
	230	if (count < hw->len)
	231	writeb(hw_txbyte(hw, count), hw->regs + S3C2410_SPTDAT);
	232	else
	233	complete(&hw->done);
	234
	235	irq_done:
	236	return IRQ_HANDLED;
	237	}
	238
d1e44d9c	239	static int __init s3c24xx_spi_probe(struct platform_device *pdev)
7fba5340	240	{
50f426b5	241	struct s3c2410_spi_info *pdata;
7fba5340 BD	242	struct s3c24xx_spi *hw;
7fba5340 BD	243	struct spi_master *master;
7fba5340 BD	244	struct resource *res;
7fba5340 BD	245	int err = 0;
7fba5340 BD	246
	247	master = spi_alloc_master(&pdev->dev, sizeof(struct s3c24xx_spi));
	248	if (master == NULL) {
	249	dev_err(&pdev->dev, "No memory for spi_master\n");
	250	err = -ENOMEM;
	251	goto err_nomem;
	252	}
	253
	254	hw = spi_master_get_devdata(master);
	255	memset(hw, 0, sizeof(struct s3c24xx_spi));
	256
	257	hw->master = spi_master_get(master);
50f426b5	258	hw->pdata = pdata = pdev->dev.platform_data;
7fba5340 BD	259	hw->dev = &pdev->dev;
7fba5340 BD	260
50f426b5	261	if (pdata == NULL) {
7fba5340 BD	262	dev_err(&pdev->dev, "No platform data supplied\n");
	263	err = -ENOENT;
	264	goto err_no_pdata;
	265	}
	266
	267	platform_set_drvdata(pdev, hw);
	268	init_completion(&hw->done);
	269
	270	/* setup the state for the bitbang driver */
	271
	272	hw->bitbang.master = hw->master;
	273	hw->bitbang.setup_transfer = s3c24xx_spi_setupxfer;
	274	hw->bitbang.chipselect = s3c24xx_spi_chipsel;
	275	hw->bitbang.txrx_bufs = s3c24xx_spi_txrx;
	276	hw->bitbang.master->setup = s3c24xx_spi_setup;
	277
	278	dev_dbg(hw->dev, "bitbang at %p\n", &hw->bitbang);
	279
	280	/* find and map our resources */
	281
	282	res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
	283	if (res == NULL) {
	284	dev_err(&pdev->dev, "Cannot get IORESOURCE_MEM\n");
	285	err = -ENOENT;
	286	goto err_no_iores;
	287	}
	288
	289	hw->ioarea = request_mem_region(res->start, (res->end - res->start)+1,
	290	pdev->name);
	291
	292	if (hw->ioarea == NULL) {
	293	dev_err(&pdev->dev, "Cannot reserve region\n");
	294	err = -ENXIO;
	295	goto err_no_iores;
	296	}
	297
	298	hw->regs = ioremap(res->start, (res->end - res->start)+1);
	299	if (hw->regs == NULL) {
	300	dev_err(&pdev->dev, "Cannot map IO\n");
	301	err = -ENXIO;
	302	goto err_no_iomap;
	303	}
	304
	305	hw->irq = platform_get_irq(pdev, 0);
	306	if (hw->irq < 0) {
	307	dev_err(&pdev->dev, "No IRQ specified\n");
	308	err = -ENOENT;
	309	goto err_no_irq;
	310	}
	311
	312	err = request_irq(hw->irq, s3c24xx_spi_irq, 0, pdev->name, hw);
	313	if (err) {
	314	dev_err(&pdev->dev, "Cannot claim IRQ\n");
	315	goto err_no_irq;
	316	}
	317
	318	hw->clk = clk_get(&pdev->dev, "spi");
	319	if (IS_ERR(hw->clk)) {
	320	dev_err(&pdev->dev, "No clock for device\n");
	321	err = PTR_ERR(hw->clk);
	322	goto err_no_clk;
	323	}
	324
	325	/* for the moment, permanently enable the clock */
326
327	clk_enable(hw->clk);
328
329	/* program defaults into the registers */
330
331	writeb(0xff, hw->regs + S3C2410_SPPRE);
332	writeb(SPPIN_DEFAULT, hw->regs + S3C2410_SPPIN);
333	writeb(SPCON_DEFAULT, hw->regs + S3C2410_SPCON);
334
335	/* setup any gpio we can */
336
50f426b5	337	if (!pdata->set_cs) {
8736b927 BD	338	hw->set_cs = s3c24xx_spi_gpiocs;
8736b927 BD	339
50f426b5 BD	340	s3c2410_gpio_setpin(pdata->pin_cs, 1);
50f426b5 BD	341	s3c2410_gpio_cfgpin(pdata->pin_cs, S3C2410_GPIO_OUTPUT);
8736b927	342	} else
50f426b5	343	hw->set_cs = pdata->set_cs;
7fba5340 BD	344
	345	/* register our spi controller */
	346
	347	err = spi_bitbang_start(&hw->bitbang);
	348	if (err) {
	349	dev_err(&pdev->dev, "Failed to register SPI master\n");
	350	goto err_register;
	351	}
	352
7fba5340 BD	353	return 0;
	354
	355	err_register:
	356	clk_disable(hw->clk);
	357	clk_put(hw->clk);
	358
	359	err_no_clk:
	360	free_irq(hw->irq, hw);
	361
	362	err_no_irq:
	363	iounmap(hw->regs);
	364
	365	err_no_iomap:
	366	release_resource(hw->ioarea);
	367	kfree(hw->ioarea);
	368
	369	err_no_iores:
	370	err_no_pdata:
	371	spi_master_put(hw->master);;
	372
	373	err_nomem:
	374	return err;
	375	}
	376
d1e44d9c	377	static int __exit s3c24xx_spi_remove(struct platform_device *dev)
7fba5340 BD	378	{
	379	struct s3c24xx_spi *hw = platform_get_drvdata(dev);
	380
	381	platform_set_drvdata(dev, NULL);
	382
	383	spi_unregister_master(hw->master);
	384
	385	clk_disable(hw->clk);
	386	clk_put(hw->clk);
	387
	388	free_irq(hw->irq, hw);
	389	iounmap(hw->regs);
	390
	391	release_resource(hw->ioarea);
	392	kfree(hw->ioarea);
	393
	394	spi_master_put(hw->master);
	395	return 0;
	396	}
	397
	398
	399	#ifdef CONFIG_PM
	400
	401	static int s3c24xx_spi_suspend(struct platform_device *pdev, pm_message_t msg)
	402	{
ac88bcff	403	struct s3c24xx_spi *hw = platform_get_drvdata(pdev);
7fba5340 BD	404
	405	clk_disable(hw->clk);
	406	return 0;
	407	}
	408
	409	static int s3c24xx_spi_resume(struct platform_device *pdev)
	410	{
ac88bcff	411	struct s3c24xx_spi *hw = platform_get_drvdata(pdev);
7fba5340 BD	412
	413	clk_enable(hw->clk);
	414	return 0;
	415	}
	416
	417	#else
	418	#define s3c24xx_spi_suspend NULL
	419	#define s3c24xx_spi_resume NULL
	420	#endif
	421
7e38c3c4	422	MODULE_ALIAS("platform:s3c2410-spi");
7fba5340	423	static struct platform_driver s3c24xx_spidrv = {
d1e44d9c	424	.remove = __exit_p(s3c24xx_spi_remove),
7fba5340 BD	425	.suspend = s3c24xx_spi_suspend,
	426	.resume = s3c24xx_spi_resume,
	427	.driver = {
	428	.name = "s3c2410-spi",
	429	.owner = THIS_MODULE,
	430	},
	431	};
	432
	433	static int __init s3c24xx_spi_init(void)
	434	{
d1e44d9c	435	return platform_driver_probe(&s3c24xx_spidrv, s3c24xx_spi_probe);
7fba5340 BD	436	}
	437
	438	static void __exit s3c24xx_spi_exit(void)
	439	{
	440	platform_driver_unregister(&s3c24xx_spidrv);
	441	}
	442
	443	module_init(s3c24xx_spi_init);
	444	module_exit(s3c24xx_spi_exit);
	445
	446	MODULE_DESCRIPTION("S3C24XX SPI Driver");
	447	MODULE_AUTHOR("Ben Dooks, <ben@simtec.co.uk>");
	448	MODULE_LICENSE("GPL");