 940ab88962
			
		
	
	
	940ab88962
	
	
	
		
			
			For simple modules that contain a single platform_driver without any additional setup code then ends up being a block of duplicated boilerplate. This patch adds a new macro, module_platform_driver(), which replaces the module_init()/module_exit() registrations with template functions. Signed-off-by: Grant Likely <grant.likely@secretlab.ca> Acked-by: Greg Kroah-Hartman <gregkh@suse.de> Reviewed-by: Magnus Damm <magnus.damm@gmail.com> Reviewed-by: Mark Brown <broonie@opensource.wolfsonmicro.com> Reviewed-by: Stephen Boyd <sboyd@codeaurora.org>
		
			
				
	
	
		
			751 lines
		
	
	
	
		
			18 KiB
			
		
	
	
	
		
			C
		
	
	
	
	
	
			
		
		
	
	
			751 lines
		
	
	
	
		
			18 KiB
			
		
	
	
	
		
			C
		
	
	
	
	
	
| /*
 | |
|  * Freescale eSPI controller driver.
 | |
|  *
 | |
|  * Copyright 2010 Freescale Semiconductor, Inc.
 | |
|  *
 | |
|  * This program is free software; you can redistribute  it and/or modify it
 | |
|  * under  the terms of  the GNU General  Public License as published by the
 | |
|  * Free Software Foundation;  either version 2 of the  License, or (at your
 | |
|  * option) any later version.
 | |
|  */
 | |
| #include <linux/module.h>
 | |
| #include <linux/delay.h>
 | |
| #include <linux/irq.h>
 | |
| #include <linux/spi/spi.h>
 | |
| #include <linux/platform_device.h>
 | |
| #include <linux/fsl_devices.h>
 | |
| #include <linux/mm.h>
 | |
| #include <linux/of.h>
 | |
| #include <linux/of_platform.h>
 | |
| #include <linux/of_spi.h>
 | |
| #include <linux/interrupt.h>
 | |
| #include <linux/err.h>
 | |
| #include <sysdev/fsl_soc.h>
 | |
| 
 | |
| #include "spi-fsl-lib.h"
 | |
| 
 | |
| /* eSPI Controller registers */
 | |
| struct fsl_espi_reg {
 | |
| 	__be32 mode;		/* 0x000 - eSPI mode register */
 | |
| 	__be32 event;		/* 0x004 - eSPI event register */
 | |
| 	__be32 mask;		/* 0x008 - eSPI mask register */
 | |
| 	__be32 command;		/* 0x00c - eSPI command register */
 | |
| 	__be32 transmit;	/* 0x010 - eSPI transmit FIFO access register*/
 | |
| 	__be32 receive;		/* 0x014 - eSPI receive FIFO access register*/
 | |
| 	u8 res[8];		/* 0x018 - 0x01c reserved */
 | |
| 	__be32 csmode[4];	/* 0x020 - 0x02c eSPI cs mode register */
 | |
| };
 | |
| 
 | |
| struct fsl_espi_transfer {
 | |
| 	const void *tx_buf;
 | |
| 	void *rx_buf;
 | |
| 	unsigned len;
 | |
| 	unsigned n_tx;
 | |
| 	unsigned n_rx;
 | |
| 	unsigned actual_length;
 | |
| 	int status;
 | |
| };
 | |
| 
 | |
| /* eSPI Controller mode register definitions */
 | |
| #define SPMODE_ENABLE		(1 << 31)
 | |
| #define SPMODE_LOOP		(1 << 30)
 | |
| #define SPMODE_TXTHR(x)		((x) << 8)
 | |
| #define SPMODE_RXTHR(x)		((x) << 0)
 | |
| 
 | |
| /* eSPI Controller CS mode register definitions */
 | |
| #define CSMODE_CI_INACTIVEHIGH	(1 << 31)
 | |
| #define CSMODE_CP_BEGIN_EDGECLK	(1 << 30)
 | |
| #define CSMODE_REV		(1 << 29)
 | |
| #define CSMODE_DIV16		(1 << 28)
 | |
| #define CSMODE_PM(x)		((x) << 24)
 | |
| #define CSMODE_POL_1		(1 << 20)
 | |
| #define CSMODE_LEN(x)		((x) << 16)
 | |
| #define CSMODE_BEF(x)		((x) << 12)
 | |
| #define CSMODE_AFT(x)		((x) << 8)
 | |
| #define CSMODE_CG(x)		((x) << 3)
 | |
| 
 | |
| /* Default mode/csmode for eSPI controller */
 | |
| #define SPMODE_INIT_VAL (SPMODE_TXTHR(4) | SPMODE_RXTHR(3))
 | |
| #define CSMODE_INIT_VAL (CSMODE_POL_1 | CSMODE_BEF(0) \
 | |
| 		| CSMODE_AFT(0) | CSMODE_CG(1))
 | |
| 
 | |
| /* SPIE register values */
 | |
| #define	SPIE_NE		0x00000200	/* Not empty */
 | |
| #define	SPIE_NF		0x00000100	/* Not full */
 | |
| 
 | |
| /* SPIM register values */
 | |
| #define	SPIM_NE		0x00000200	/* Not empty */
 | |
| #define	SPIM_NF		0x00000100	/* Not full */
 | |
| #define SPIE_RXCNT(reg)     ((reg >> 24) & 0x3F)
 | |
| #define SPIE_TXCNT(reg)     ((reg >> 16) & 0x3F)
 | |
| 
 | |
| /* SPCOM register values */
 | |
| #define SPCOM_CS(x)		((x) << 30)
 | |
| #define SPCOM_TRANLEN(x)	((x) << 0)
 | |
| #define	SPCOM_TRANLEN_MAX	0xFFFF	/* Max transaction length */
 | |
| 
 | |
| static void fsl_espi_change_mode(struct spi_device *spi)
 | |
| {
 | |
| 	struct mpc8xxx_spi *mspi = spi_master_get_devdata(spi->master);
 | |
| 	struct spi_mpc8xxx_cs *cs = spi->controller_state;
 | |
| 	struct fsl_espi_reg *reg_base = mspi->reg_base;
 | |
| 	__be32 __iomem *mode = ®_base->csmode[spi->chip_select];
 | |
| 	__be32 __iomem *espi_mode = ®_base->mode;
 | |
| 	u32 tmp;
 | |
| 	unsigned long flags;
 | |
| 
 | |
| 	/* Turn off IRQs locally to minimize time that SPI is disabled. */
 | |
| 	local_irq_save(flags);
 | |
| 
 | |
| 	/* Turn off SPI unit prior changing mode */
 | |
| 	tmp = mpc8xxx_spi_read_reg(espi_mode);
 | |
| 	mpc8xxx_spi_write_reg(espi_mode, tmp & ~SPMODE_ENABLE);
 | |
| 	mpc8xxx_spi_write_reg(mode, cs->hw_mode);
 | |
| 	mpc8xxx_spi_write_reg(espi_mode, tmp);
 | |
| 
 | |
| 	local_irq_restore(flags);
 | |
| }
 | |
| 
 | |
| static u32 fsl_espi_tx_buf_lsb(struct mpc8xxx_spi *mpc8xxx_spi)
 | |
| {
 | |
| 	u32 data;
 | |
| 	u16 data_h;
 | |
| 	u16 data_l;
 | |
| 	const u32 *tx = mpc8xxx_spi->tx;
 | |
| 
 | |
| 	if (!tx)
 | |
| 		return 0;
 | |
| 
 | |
| 	data = *tx++ << mpc8xxx_spi->tx_shift;
 | |
| 	data_l = data & 0xffff;
 | |
| 	data_h = (data >> 16) & 0xffff;
 | |
| 	swab16s(&data_l);
 | |
| 	swab16s(&data_h);
 | |
| 	data = data_h | data_l;
 | |
| 
 | |
| 	mpc8xxx_spi->tx = tx;
 | |
| 	return data;
 | |
| }
 | |
| 
 | |
| static int fsl_espi_setup_transfer(struct spi_device *spi,
 | |
| 					struct spi_transfer *t)
 | |
| {
 | |
| 	struct mpc8xxx_spi *mpc8xxx_spi = spi_master_get_devdata(spi->master);
 | |
| 	int bits_per_word = 0;
 | |
| 	u8 pm;
 | |
| 	u32 hz = 0;
 | |
| 	struct spi_mpc8xxx_cs *cs = spi->controller_state;
 | |
| 
 | |
| 	if (t) {
 | |
| 		bits_per_word = t->bits_per_word;
 | |
| 		hz = t->speed_hz;
 | |
| 	}
 | |
| 
 | |
| 	/* spi_transfer level calls that work per-word */
 | |
| 	if (!bits_per_word)
 | |
| 		bits_per_word = spi->bits_per_word;
 | |
| 
 | |
| 	/* Make sure its a bit width we support [4..16] */
 | |
| 	if ((bits_per_word < 4) || (bits_per_word > 16))
 | |
| 		return -EINVAL;
 | |
| 
 | |
| 	if (!hz)
 | |
| 		hz = spi->max_speed_hz;
 | |
| 
 | |
| 	cs->rx_shift = 0;
 | |
| 	cs->tx_shift = 0;
 | |
| 	cs->get_rx = mpc8xxx_spi_rx_buf_u32;
 | |
| 	cs->get_tx = mpc8xxx_spi_tx_buf_u32;
 | |
| 	if (bits_per_word <= 8) {
 | |
| 		cs->rx_shift = 8 - bits_per_word;
 | |
| 	} else if (bits_per_word <= 16) {
 | |
| 		cs->rx_shift = 16 - bits_per_word;
 | |
| 		if (spi->mode & SPI_LSB_FIRST)
 | |
| 			cs->get_tx = fsl_espi_tx_buf_lsb;
 | |
| 	} else {
 | |
| 		return -EINVAL;
 | |
| 	}
 | |
| 
 | |
| 	mpc8xxx_spi->rx_shift = cs->rx_shift;
 | |
| 	mpc8xxx_spi->tx_shift = cs->tx_shift;
 | |
| 	mpc8xxx_spi->get_rx = cs->get_rx;
 | |
| 	mpc8xxx_spi->get_tx = cs->get_tx;
 | |
| 
 | |
| 	bits_per_word = bits_per_word - 1;
 | |
| 
 | |
| 	/* mask out bits we are going to set */
 | |
| 	cs->hw_mode &= ~(CSMODE_LEN(0xF) | CSMODE_DIV16 | CSMODE_PM(0xF));
 | |
| 
 | |
| 	cs->hw_mode |= CSMODE_LEN(bits_per_word);
 | |
| 
 | |
| 	if ((mpc8xxx_spi->spibrg / hz) > 64) {
 | |
| 		cs->hw_mode |= CSMODE_DIV16;
 | |
| 		pm = (mpc8xxx_spi->spibrg - 1) / (hz * 64) + 1;
 | |
| 
 | |
| 		WARN_ONCE(pm > 16, "%s: Requested speed is too low: %d Hz. "
 | |
| 			  "Will use %d Hz instead.\n", dev_name(&spi->dev),
 | |
| 			  hz, mpc8xxx_spi->spibrg / 1024);
 | |
| 		if (pm > 16)
 | |
| 			pm = 16;
 | |
| 	} else {
 | |
| 		pm = (mpc8xxx_spi->spibrg - 1) / (hz * 4) + 1;
 | |
| 	}
 | |
| 	if (pm)
 | |
| 		pm--;
 | |
| 
 | |
| 	cs->hw_mode |= CSMODE_PM(pm);
 | |
| 
 | |
| 	fsl_espi_change_mode(spi);
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| static int fsl_espi_cpu_bufs(struct mpc8xxx_spi *mspi, struct spi_transfer *t,
 | |
| 		unsigned int len)
 | |
| {
 | |
| 	u32 word;
 | |
| 	struct fsl_espi_reg *reg_base = mspi->reg_base;
 | |
| 
 | |
| 	mspi->count = len;
 | |
| 
 | |
| 	/* enable rx ints */
 | |
| 	mpc8xxx_spi_write_reg(®_base->mask, SPIM_NE);
 | |
| 
 | |
| 	/* transmit word */
 | |
| 	word = mspi->get_tx(mspi);
 | |
| 	mpc8xxx_spi_write_reg(®_base->transmit, word);
 | |
| 
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| static int fsl_espi_bufs(struct spi_device *spi, struct spi_transfer *t)
 | |
| {
 | |
| 	struct mpc8xxx_spi *mpc8xxx_spi = spi_master_get_devdata(spi->master);
 | |
| 	struct fsl_espi_reg *reg_base = mpc8xxx_spi->reg_base;
 | |
| 	unsigned int len = t->len;
 | |
| 	u8 bits_per_word;
 | |
| 	int ret;
 | |
| 
 | |
| 	bits_per_word = spi->bits_per_word;
 | |
| 	if (t->bits_per_word)
 | |
| 		bits_per_word = t->bits_per_word;
 | |
| 
 | |
| 	mpc8xxx_spi->len = t->len;
 | |
| 	len = roundup(len, 4) / 4;
 | |
| 
 | |
| 	mpc8xxx_spi->tx = t->tx_buf;
 | |
| 	mpc8xxx_spi->rx = t->rx_buf;
 | |
| 
 | |
| 	INIT_COMPLETION(mpc8xxx_spi->done);
 | |
| 
 | |
| 	/* Set SPCOM[CS] and SPCOM[TRANLEN] field */
 | |
| 	if ((t->len - 1) > SPCOM_TRANLEN_MAX) {
 | |
| 		dev_err(mpc8xxx_spi->dev, "Transaction length (%d)"
 | |
| 				" beyond the SPCOM[TRANLEN] field\n", t->len);
 | |
| 		return -EINVAL;
 | |
| 	}
 | |
| 	mpc8xxx_spi_write_reg(®_base->command,
 | |
| 		(SPCOM_CS(spi->chip_select) | SPCOM_TRANLEN(t->len - 1)));
 | |
| 
 | |
| 	ret = fsl_espi_cpu_bufs(mpc8xxx_spi, t, len);
 | |
| 	if (ret)
 | |
| 		return ret;
 | |
| 
 | |
| 	wait_for_completion(&mpc8xxx_spi->done);
 | |
| 
 | |
| 	/* disable rx ints */
 | |
| 	mpc8xxx_spi_write_reg(®_base->mask, 0);
 | |
| 
 | |
| 	return mpc8xxx_spi->count;
 | |
| }
 | |
| 
 | |
| static inline void fsl_espi_addr2cmd(unsigned int addr, u8 *cmd)
 | |
| {
 | |
| 	if (cmd) {
 | |
| 		cmd[1] = (u8)(addr >> 16);
 | |
| 		cmd[2] = (u8)(addr >> 8);
 | |
| 		cmd[3] = (u8)(addr >> 0);
 | |
| 	}
 | |
| }
 | |
| 
 | |
| static inline unsigned int fsl_espi_cmd2addr(u8 *cmd)
 | |
| {
 | |
| 	if (cmd)
 | |
| 		return cmd[1] << 16 | cmd[2] << 8 | cmd[3] << 0;
 | |
| 
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| static void fsl_espi_do_trans(struct spi_message *m,
 | |
| 				struct fsl_espi_transfer *tr)
 | |
| {
 | |
| 	struct spi_device *spi = m->spi;
 | |
| 	struct mpc8xxx_spi *mspi = spi_master_get_devdata(spi->master);
 | |
| 	struct fsl_espi_transfer *espi_trans = tr;
 | |
| 	struct spi_message message;
 | |
| 	struct spi_transfer *t, *first, trans;
 | |
| 	int status = 0;
 | |
| 
 | |
| 	spi_message_init(&message);
 | |
| 	memset(&trans, 0, sizeof(trans));
 | |
| 
 | |
| 	first = list_first_entry(&m->transfers, struct spi_transfer,
 | |
| 			transfer_list);
 | |
| 	list_for_each_entry(t, &m->transfers, transfer_list) {
 | |
| 		if ((first->bits_per_word != t->bits_per_word) ||
 | |
| 			(first->speed_hz != t->speed_hz)) {
 | |
| 			espi_trans->status = -EINVAL;
 | |
| 			dev_err(mspi->dev, "bits_per_word/speed_hz should be"
 | |
| 					" same for the same SPI transfer\n");
 | |
| 			return;
 | |
| 		}
 | |
| 
 | |
| 		trans.speed_hz = t->speed_hz;
 | |
| 		trans.bits_per_word = t->bits_per_word;
 | |
| 		trans.delay_usecs = max(first->delay_usecs, t->delay_usecs);
 | |
| 	}
 | |
| 
 | |
| 	trans.len = espi_trans->len;
 | |
| 	trans.tx_buf = espi_trans->tx_buf;
 | |
| 	trans.rx_buf = espi_trans->rx_buf;
 | |
| 	spi_message_add_tail(&trans, &message);
 | |
| 
 | |
| 	list_for_each_entry(t, &message.transfers, transfer_list) {
 | |
| 		if (t->bits_per_word || t->speed_hz) {
 | |
| 			status = -EINVAL;
 | |
| 
 | |
| 			status = fsl_espi_setup_transfer(spi, t);
 | |
| 			if (status < 0)
 | |
| 				break;
 | |
| 		}
 | |
| 
 | |
| 		if (t->len)
 | |
| 			status = fsl_espi_bufs(spi, t);
 | |
| 
 | |
| 		if (status) {
 | |
| 			status = -EMSGSIZE;
 | |
| 			break;
 | |
| 		}
 | |
| 
 | |
| 		if (t->delay_usecs)
 | |
| 			udelay(t->delay_usecs);
 | |
| 	}
 | |
| 
 | |
| 	espi_trans->status = status;
 | |
| 	fsl_espi_setup_transfer(spi, NULL);
 | |
| }
 | |
| 
 | |
| static void fsl_espi_cmd_trans(struct spi_message *m,
 | |
| 				struct fsl_espi_transfer *trans, u8 *rx_buff)
 | |
| {
 | |
| 	struct spi_transfer *t;
 | |
| 	u8 *local_buf;
 | |
| 	int i = 0;
 | |
| 	struct fsl_espi_transfer *espi_trans = trans;
 | |
| 
 | |
| 	local_buf = kzalloc(SPCOM_TRANLEN_MAX, GFP_KERNEL);
 | |
| 	if (!local_buf) {
 | |
| 		espi_trans->status = -ENOMEM;
 | |
| 		return;
 | |
| 	}
 | |
| 
 | |
| 	list_for_each_entry(t, &m->transfers, transfer_list) {
 | |
| 		if (t->tx_buf) {
 | |
| 			memcpy(local_buf + i, t->tx_buf, t->len);
 | |
| 			i += t->len;
 | |
| 		}
 | |
| 	}
 | |
| 
 | |
| 	espi_trans->tx_buf = local_buf;
 | |
| 	espi_trans->rx_buf = local_buf + espi_trans->n_tx;
 | |
| 	fsl_espi_do_trans(m, espi_trans);
 | |
| 
 | |
| 	espi_trans->actual_length = espi_trans->len;
 | |
| 	kfree(local_buf);
 | |
| }
 | |
| 
 | |
| static void fsl_espi_rw_trans(struct spi_message *m,
 | |
| 				struct fsl_espi_transfer *trans, u8 *rx_buff)
 | |
| {
 | |
| 	struct fsl_espi_transfer *espi_trans = trans;
 | |
| 	unsigned int n_tx = espi_trans->n_tx;
 | |
| 	unsigned int n_rx = espi_trans->n_rx;
 | |
| 	struct spi_transfer *t;
 | |
| 	u8 *local_buf;
 | |
| 	u8 *rx_buf = rx_buff;
 | |
| 	unsigned int trans_len;
 | |
| 	unsigned int addr;
 | |
| 	int i, pos, loop;
 | |
| 
 | |
| 	local_buf = kzalloc(SPCOM_TRANLEN_MAX, GFP_KERNEL);
 | |
| 	if (!local_buf) {
 | |
| 		espi_trans->status = -ENOMEM;
 | |
| 		return;
 | |
| 	}
 | |
| 
 | |
| 	for (pos = 0, loop = 0; pos < n_rx; pos += trans_len, loop++) {
 | |
| 		trans_len = n_rx - pos;
 | |
| 		if (trans_len > SPCOM_TRANLEN_MAX - n_tx)
 | |
| 			trans_len = SPCOM_TRANLEN_MAX - n_tx;
 | |
| 
 | |
| 		i = 0;
 | |
| 		list_for_each_entry(t, &m->transfers, transfer_list) {
 | |
| 			if (t->tx_buf) {
 | |
| 				memcpy(local_buf + i, t->tx_buf, t->len);
 | |
| 				i += t->len;
 | |
| 			}
 | |
| 		}
 | |
| 
 | |
| 		if (pos > 0) {
 | |
| 			addr = fsl_espi_cmd2addr(local_buf);
 | |
| 			addr += pos;
 | |
| 			fsl_espi_addr2cmd(addr, local_buf);
 | |
| 		}
 | |
| 
 | |
| 		espi_trans->n_tx = n_tx;
 | |
| 		espi_trans->n_rx = trans_len;
 | |
| 		espi_trans->len = trans_len + n_tx;
 | |
| 		espi_trans->tx_buf = local_buf;
 | |
| 		espi_trans->rx_buf = local_buf + n_tx;
 | |
| 		fsl_espi_do_trans(m, espi_trans);
 | |
| 
 | |
| 		memcpy(rx_buf + pos, espi_trans->rx_buf + n_tx, trans_len);
 | |
| 
 | |
| 		if (loop > 0)
 | |
| 			espi_trans->actual_length += espi_trans->len - n_tx;
 | |
| 		else
 | |
| 			espi_trans->actual_length += espi_trans->len;
 | |
| 	}
 | |
| 
 | |
| 	kfree(local_buf);
 | |
| }
 | |
| 
 | |
| static void fsl_espi_do_one_msg(struct spi_message *m)
 | |
| {
 | |
| 	struct spi_transfer *t;
 | |
| 	u8 *rx_buf = NULL;
 | |
| 	unsigned int n_tx = 0;
 | |
| 	unsigned int n_rx = 0;
 | |
| 	struct fsl_espi_transfer espi_trans;
 | |
| 
 | |
| 	list_for_each_entry(t, &m->transfers, transfer_list) {
 | |
| 		if (t->tx_buf)
 | |
| 			n_tx += t->len;
 | |
| 		if (t->rx_buf) {
 | |
| 			n_rx += t->len;
 | |
| 			rx_buf = t->rx_buf;
 | |
| 		}
 | |
| 	}
 | |
| 
 | |
| 	espi_trans.n_tx = n_tx;
 | |
| 	espi_trans.n_rx = n_rx;
 | |
| 	espi_trans.len = n_tx + n_rx;
 | |
| 	espi_trans.actual_length = 0;
 | |
| 	espi_trans.status = 0;
 | |
| 
 | |
| 	if (!rx_buf)
 | |
| 		fsl_espi_cmd_trans(m, &espi_trans, NULL);
 | |
| 	else
 | |
| 		fsl_espi_rw_trans(m, &espi_trans, rx_buf);
 | |
| 
 | |
| 	m->actual_length = espi_trans.actual_length;
 | |
| 	m->status = espi_trans.status;
 | |
| 	m->complete(m->context);
 | |
| }
 | |
| 
 | |
| static int fsl_espi_setup(struct spi_device *spi)
 | |
| {
 | |
| 	struct mpc8xxx_spi *mpc8xxx_spi;
 | |
| 	struct fsl_espi_reg *reg_base;
 | |
| 	int retval;
 | |
| 	u32 hw_mode;
 | |
| 	u32 loop_mode;
 | |
| 	struct spi_mpc8xxx_cs *cs = spi->controller_state;
 | |
| 
 | |
| 	if (!spi->max_speed_hz)
 | |
| 		return -EINVAL;
 | |
| 
 | |
| 	if (!cs) {
 | |
| 		cs = kzalloc(sizeof *cs, GFP_KERNEL);
 | |
| 		if (!cs)
 | |
| 			return -ENOMEM;
 | |
| 		spi->controller_state = cs;
 | |
| 	}
 | |
| 
 | |
| 	mpc8xxx_spi = spi_master_get_devdata(spi->master);
 | |
| 	reg_base = mpc8xxx_spi->reg_base;
 | |
| 
 | |
| 	hw_mode = cs->hw_mode; /* Save original settings */
 | |
| 	cs->hw_mode = mpc8xxx_spi_read_reg(
 | |
| 			®_base->csmode[spi->chip_select]);
 | |
| 	/* mask out bits we are going to set */
 | |
| 	cs->hw_mode &= ~(CSMODE_CP_BEGIN_EDGECLK | CSMODE_CI_INACTIVEHIGH
 | |
| 			 | CSMODE_REV);
 | |
| 
 | |
| 	if (spi->mode & SPI_CPHA)
 | |
| 		cs->hw_mode |= CSMODE_CP_BEGIN_EDGECLK;
 | |
| 	if (spi->mode & SPI_CPOL)
 | |
| 		cs->hw_mode |= CSMODE_CI_INACTIVEHIGH;
 | |
| 	if (!(spi->mode & SPI_LSB_FIRST))
 | |
| 		cs->hw_mode |= CSMODE_REV;
 | |
| 
 | |
| 	/* Handle the loop mode */
 | |
| 	loop_mode = mpc8xxx_spi_read_reg(®_base->mode);
 | |
| 	loop_mode &= ~SPMODE_LOOP;
 | |
| 	if (spi->mode & SPI_LOOP)
 | |
| 		loop_mode |= SPMODE_LOOP;
 | |
| 	mpc8xxx_spi_write_reg(®_base->mode, loop_mode);
 | |
| 
 | |
| 	retval = fsl_espi_setup_transfer(spi, NULL);
 | |
| 	if (retval < 0) {
 | |
| 		cs->hw_mode = hw_mode; /* Restore settings */
 | |
| 		return retval;
 | |
| 	}
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| void fsl_espi_cpu_irq(struct mpc8xxx_spi *mspi, u32 events)
 | |
| {
 | |
| 	struct fsl_espi_reg *reg_base = mspi->reg_base;
 | |
| 
 | |
| 	/* We need handle RX first */
 | |
| 	if (events & SPIE_NE) {
 | |
| 		u32 rx_data, tmp;
 | |
| 		u8 rx_data_8;
 | |
| 
 | |
| 		/* Spin until RX is done */
 | |
| 		while (SPIE_RXCNT(events) < min(4, mspi->len)) {
 | |
| 			cpu_relax();
 | |
| 			events = mpc8xxx_spi_read_reg(®_base->event);
 | |
| 		}
 | |
| 
 | |
| 		if (mspi->len >= 4) {
 | |
| 			rx_data = mpc8xxx_spi_read_reg(®_base->receive);
 | |
| 		} else {
 | |
| 			tmp = mspi->len;
 | |
| 			rx_data = 0;
 | |
| 			while (tmp--) {
 | |
| 				rx_data_8 = in_8((u8 *)®_base->receive);
 | |
| 				rx_data |= (rx_data_8 << (tmp * 8));
 | |
| 			}
 | |
| 
 | |
| 			rx_data <<= (4 - mspi->len) * 8;
 | |
| 		}
 | |
| 
 | |
| 		mspi->len -= 4;
 | |
| 
 | |
| 		if (mspi->rx)
 | |
| 			mspi->get_rx(rx_data, mspi);
 | |
| 	}
 | |
| 
 | |
| 	if (!(events & SPIE_NF)) {
 | |
| 		int ret;
 | |
| 
 | |
| 		/* spin until TX is done */
 | |
| 		ret = spin_event_timeout(((events = mpc8xxx_spi_read_reg(
 | |
| 				®_base->event)) & SPIE_NF) == 0, 1000, 0);
 | |
| 		if (!ret) {
 | |
| 			dev_err(mspi->dev, "tired waiting for SPIE_NF\n");
 | |
| 			return;
 | |
| 		}
 | |
| 	}
 | |
| 
 | |
| 	/* Clear the events */
 | |
| 	mpc8xxx_spi_write_reg(®_base->event, events);
 | |
| 
 | |
| 	mspi->count -= 1;
 | |
| 	if (mspi->count) {
 | |
| 		u32 word = mspi->get_tx(mspi);
 | |
| 
 | |
| 		mpc8xxx_spi_write_reg(®_base->transmit, word);
 | |
| 	} else {
 | |
| 		complete(&mspi->done);
 | |
| 	}
 | |
| }
 | |
| 
 | |
| static irqreturn_t fsl_espi_irq(s32 irq, void *context_data)
 | |
| {
 | |
| 	struct mpc8xxx_spi *mspi = context_data;
 | |
| 	struct fsl_espi_reg *reg_base = mspi->reg_base;
 | |
| 	irqreturn_t ret = IRQ_NONE;
 | |
| 	u32 events;
 | |
| 
 | |
| 	/* Get interrupt events(tx/rx) */
 | |
| 	events = mpc8xxx_spi_read_reg(®_base->event);
 | |
| 	if (events)
 | |
| 		ret = IRQ_HANDLED;
 | |
| 
 | |
| 	dev_vdbg(mspi->dev, "%s: events %x\n", __func__, events);
 | |
| 
 | |
| 	fsl_espi_cpu_irq(mspi, events);
 | |
| 
 | |
| 	return ret;
 | |
| }
 | |
| 
 | |
| static void fsl_espi_remove(struct mpc8xxx_spi *mspi)
 | |
| {
 | |
| 	iounmap(mspi->reg_base);
 | |
| }
 | |
| 
 | |
| static struct spi_master * __devinit fsl_espi_probe(struct device *dev,
 | |
| 		struct resource *mem, unsigned int irq)
 | |
| {
 | |
| 	struct fsl_spi_platform_data *pdata = dev->platform_data;
 | |
| 	struct spi_master *master;
 | |
| 	struct mpc8xxx_spi *mpc8xxx_spi;
 | |
| 	struct fsl_espi_reg *reg_base;
 | |
| 	u32 regval;
 | |
| 	int i, ret = 0;
 | |
| 
 | |
| 	master = spi_alloc_master(dev, sizeof(struct mpc8xxx_spi));
 | |
| 	if (!master) {
 | |
| 		ret = -ENOMEM;
 | |
| 		goto err;
 | |
| 	}
 | |
| 
 | |
| 	dev_set_drvdata(dev, master);
 | |
| 
 | |
| 	ret = mpc8xxx_spi_probe(dev, mem, irq);
 | |
| 	if (ret)
 | |
| 		goto err_probe;
 | |
| 
 | |
| 	master->setup = fsl_espi_setup;
 | |
| 
 | |
| 	mpc8xxx_spi = spi_master_get_devdata(master);
 | |
| 	mpc8xxx_spi->spi_do_one_msg = fsl_espi_do_one_msg;
 | |
| 	mpc8xxx_spi->spi_remove = fsl_espi_remove;
 | |
| 
 | |
| 	mpc8xxx_spi->reg_base = ioremap(mem->start, resource_size(mem));
 | |
| 	if (!mpc8xxx_spi->reg_base) {
 | |
| 		ret = -ENOMEM;
 | |
| 		goto err_probe;
 | |
| 	}
 | |
| 
 | |
| 	reg_base = mpc8xxx_spi->reg_base;
 | |
| 
 | |
| 	/* Register for SPI Interrupt */
 | |
| 	ret = request_irq(mpc8xxx_spi->irq, fsl_espi_irq,
 | |
| 			  0, "fsl_espi", mpc8xxx_spi);
 | |
| 	if (ret)
 | |
| 		goto free_irq;
 | |
| 
 | |
| 	if (mpc8xxx_spi->flags & SPI_QE_CPU_MODE) {
 | |
| 		mpc8xxx_spi->rx_shift = 16;
 | |
| 		mpc8xxx_spi->tx_shift = 24;
 | |
| 	}
 | |
| 
 | |
| 	/* SPI controller initializations */
 | |
| 	mpc8xxx_spi_write_reg(®_base->mode, 0);
 | |
| 	mpc8xxx_spi_write_reg(®_base->mask, 0);
 | |
| 	mpc8xxx_spi_write_reg(®_base->command, 0);
 | |
| 	mpc8xxx_spi_write_reg(®_base->event, 0xffffffff);
 | |
| 
 | |
| 	/* Init eSPI CS mode register */
 | |
| 	for (i = 0; i < pdata->max_chipselect; i++)
 | |
| 		mpc8xxx_spi_write_reg(®_base->csmode[i], CSMODE_INIT_VAL);
 | |
| 
 | |
| 	/* Enable SPI interface */
 | |
| 	regval = pdata->initial_spmode | SPMODE_INIT_VAL | SPMODE_ENABLE;
 | |
| 
 | |
| 	mpc8xxx_spi_write_reg(®_base->mode, regval);
 | |
| 
 | |
| 	ret = spi_register_master(master);
 | |
| 	if (ret < 0)
 | |
| 		goto unreg_master;
 | |
| 
 | |
| 	dev_info(dev, "at 0x%p (irq = %d)\n", reg_base, mpc8xxx_spi->irq);
 | |
| 
 | |
| 	return master;
 | |
| 
 | |
| unreg_master:
 | |
| 	free_irq(mpc8xxx_spi->irq, mpc8xxx_spi);
 | |
| free_irq:
 | |
| 	iounmap(mpc8xxx_spi->reg_base);
 | |
| err_probe:
 | |
| 	spi_master_put(master);
 | |
| err:
 | |
| 	return ERR_PTR(ret);
 | |
| }
 | |
| 
 | |
| static int of_fsl_espi_get_chipselects(struct device *dev)
 | |
| {
 | |
| 	struct device_node *np = dev->of_node;
 | |
| 	struct fsl_spi_platform_data *pdata = dev->platform_data;
 | |
| 	const u32 *prop;
 | |
| 	int len;
 | |
| 
 | |
| 	prop = of_get_property(np, "fsl,espi-num-chipselects", &len);
 | |
| 	if (!prop || len < sizeof(*prop)) {
 | |
| 		dev_err(dev, "No 'fsl,espi-num-chipselects' property\n");
 | |
| 		return -EINVAL;
 | |
| 	}
 | |
| 
 | |
| 	pdata->max_chipselect = *prop;
 | |
| 	pdata->cs_control = NULL;
 | |
| 
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| static int __devinit of_fsl_espi_probe(struct platform_device *ofdev)
 | |
| {
 | |
| 	struct device *dev = &ofdev->dev;
 | |
| 	struct device_node *np = ofdev->dev.of_node;
 | |
| 	struct spi_master *master;
 | |
| 	struct resource mem;
 | |
| 	struct resource irq;
 | |
| 	int ret = -ENOMEM;
 | |
| 
 | |
| 	ret = of_mpc8xxx_spi_probe(ofdev);
 | |
| 	if (ret)
 | |
| 		return ret;
 | |
| 
 | |
| 	ret = of_fsl_espi_get_chipselects(dev);
 | |
| 	if (ret)
 | |
| 		goto err;
 | |
| 
 | |
| 	ret = of_address_to_resource(np, 0, &mem);
 | |
| 	if (ret)
 | |
| 		goto err;
 | |
| 
 | |
| 	ret = of_irq_to_resource(np, 0, &irq);
 | |
| 	if (!ret) {
 | |
| 		ret = -EINVAL;
 | |
| 		goto err;
 | |
| 	}
 | |
| 
 | |
| 	master = fsl_espi_probe(dev, &mem, irq.start);
 | |
| 	if (IS_ERR(master)) {
 | |
| 		ret = PTR_ERR(master);
 | |
| 		goto err;
 | |
| 	}
 | |
| 
 | |
| 	return 0;
 | |
| 
 | |
| err:
 | |
| 	return ret;
 | |
| }
 | |
| 
 | |
| static int __devexit of_fsl_espi_remove(struct platform_device *dev)
 | |
| {
 | |
| 	return mpc8xxx_spi_remove(&dev->dev);
 | |
| }
 | |
| 
 | |
| static const struct of_device_id of_fsl_espi_match[] = {
 | |
| 	{ .compatible = "fsl,mpc8536-espi" },
 | |
| 	{}
 | |
| };
 | |
| MODULE_DEVICE_TABLE(of, of_fsl_espi_match);
 | |
| 
 | |
| static struct platform_driver fsl_espi_driver = {
 | |
| 	.driver = {
 | |
| 		.name = "fsl_espi",
 | |
| 		.owner = THIS_MODULE,
 | |
| 		.of_match_table = of_fsl_espi_match,
 | |
| 	},
 | |
| 	.probe		= of_fsl_espi_probe,
 | |
| 	.remove		= __devexit_p(of_fsl_espi_remove),
 | |
| };
 | |
| module_platform_driver(fsl_espi_driver);
 | |
| 
 | |
| MODULE_AUTHOR("Mingkai Hu");
 | |
| MODULE_DESCRIPTION("Enhanced Freescale SPI Driver");
 | |
| MODULE_LICENSE("GPL");
 |