mirror of
				https://source.denx.de/u-boot/u-boot.git
				synced 2025-10-30 07:51:42 +01:00 
			
		
		
		
	The third parameter of container_of is the name of the member within the struct. Current code only works if the parameter passed to to_cf_qspi_slave named slave. Fix it. Signed-off-by: Axel Lin <axel.lin@ingics.com> Reviewed-by: Jagannadha Sutradharudu Teki <jagannadh.teki@gmail.com>
		
			
				
	
	
		
			356 lines
		
	
	
		
			9.5 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
			
		
		
	
	
			356 lines
		
	
	
		
			9.5 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
| /*
 | |
|  * Freescale Coldfire Queued SPI driver
 | |
|  *
 | |
|  * NOTE:
 | |
|  * This driver is written to transfer 8 bit at-a-time and uses the dedicated
 | |
|  * SPI slave select pins as bit-banged GPIO to work with spi_flash subsystem.
 | |
|  *
 | |
|  * Copyright (C) 2011 Ruggedcom, Inc.
 | |
|  * Richard Retanubun (richardretanubun@freescale.com)
 | |
|  *
 | |
|  * SPDX-License-Identifier:	GPL-2.0+
 | |
|  */
 | |
| 
 | |
| #include <common.h>
 | |
| #include <malloc.h>
 | |
| #include <spi.h>
 | |
| #include <asm/immap.h>
 | |
| #include <asm/io.h>
 | |
| 
 | |
| DECLARE_GLOBAL_DATA_PTR;
 | |
| 
 | |
| #define clamp(x, low, high) (min(max(low, x), high))
 | |
| #define to_cf_qspi_slave(s) container_of(s, struct cf_qspi_slave, slave)
 | |
| 
 | |
| struct cf_qspi_slave {
 | |
| 	struct spi_slave slave;	/* Specific bus:cs ID for each device */
 | |
| 	qspi_t *regs;		/* Pointer to SPI controller registers */
 | |
| 	u16 qmr;		/* QMR: Queued Mode Register */
 | |
| 	u16 qwr;		/* QWR: Queued Wrap Register */
 | |
| 	u16 qcr;		/* QCR: Queued Command Ram */
 | |
| };
 | |
| 
 | |
| /* Register write wrapper functions */
 | |
| static void write_qmr(volatile qspi_t *qspi, u16 val)   { qspi->mr = val; }
 | |
| static void write_qdlyr(volatile qspi_t *qspi, u16 val) { qspi->dlyr = val; }
 | |
| static void write_qwr(volatile qspi_t *qspi, u16 val)   { qspi->wr = val; }
 | |
| static void write_qir(volatile qspi_t *qspi, u16 val)   { qspi->ir = val; }
 | |
| static void write_qar(volatile qspi_t *qspi, u16 val)   { qspi->ar = val; }
 | |
| static void write_qdr(volatile qspi_t *qspi, u16 val)   { qspi->dr = val; }
 | |
| /* Register read wrapper functions */
 | |
| static u16 read_qdlyr(volatile qspi_t *qspi) { return qspi->dlyr; }
 | |
| static u16 read_qwr(volatile qspi_t *qspi)   { return qspi->wr; }
 | |
| static u16 read_qir(volatile qspi_t *qspi)   { return qspi->ir; }
 | |
| static u16 read_qdr(volatile qspi_t *qspi)   { return qspi->dr; }
 | |
| 
 | |
| /* These call points may be different for each ColdFire CPU */
 | |
| extern void cfspi_port_conf(void);
 | |
| static void cfspi_cs_activate(uint bus, uint cs, uint cs_active_high);
 | |
| static void cfspi_cs_deactivate(uint bus, uint cs, uint cs_active_high);
 | |
| 
 | |
| int spi_claim_bus(struct spi_slave *slave)
 | |
| {
 | |
| 	return 0;
 | |
| }
 | |
| void spi_release_bus(struct spi_slave *slave)
 | |
| {
 | |
| }
 | |
| 
 | |
| __attribute__((weak))
 | |
| void spi_init(void)
 | |
| {
 | |
| 	cfspi_port_conf();
 | |
| }
 | |
| 
 | |
| __attribute__((weak))
 | |
| void spi_cs_activate(struct spi_slave *slave)
 | |
| {
 | |
| 	struct cf_qspi_slave *dev = to_cf_qspi_slave(slave);
 | |
| 
 | |
| 	cfspi_cs_activate(slave->bus, slave->cs, !(dev->qwr & QSPI_QWR_CSIV));
 | |
| }
 | |
| 
 | |
| __attribute__((weak))
 | |
| void spi_cs_deactivate(struct spi_slave *slave)
 | |
| {
 | |
| 	struct cf_qspi_slave *dev = to_cf_qspi_slave(slave);
 | |
| 
 | |
| 	cfspi_cs_deactivate(slave->bus, slave->cs, !(dev->qwr & QSPI_QWR_CSIV));
 | |
| }
 | |
| 
 | |
| __attribute__((weak))
 | |
| int spi_cs_is_valid(unsigned int bus, unsigned int cs)
 | |
| {
 | |
| 	/* Only 1 bus and 4 chipselect per controller */
 | |
| 	if (bus == 0 && (cs >= 0 && cs < 4))
 | |
| 		return 1;
 | |
| 	else
 | |
| 		return 0;
 | |
| }
 | |
| 
 | |
| void spi_free_slave(struct spi_slave *slave)
 | |
| {
 | |
| 	struct cf_qspi_slave *dev = to_cf_qspi_slave(slave);
 | |
| 
 | |
| 	free(dev);
 | |
| }
 | |
| 
 | |
| /* Translate information given by spi_setup_slave to members of cf_qspi_slave */
 | |
| struct spi_slave *spi_setup_slave(unsigned int bus, unsigned int cs,
 | |
| 				  unsigned int max_hz, unsigned int mode)
 | |
| {
 | |
| 	struct cf_qspi_slave *dev = NULL;
 | |
| 
 | |
| 	if (!spi_cs_is_valid(bus, cs))
 | |
| 		return NULL;
 | |
| 
 | |
| 	dev = spi_alloc_slave(struct cf_qspi_slave, bus, cs);
 | |
| 	if (!dev)
 | |
| 		return NULL;
 | |
| 
 | |
| 	/* Initialize to known value */
 | |
| 	dev->regs      = (qspi_t *)MMAP_QSPI;
 | |
| 	dev->qmr       = 0;
 | |
| 	dev->qwr       = 0;
 | |
| 	dev->qcr       = 0;
 | |
| 
 | |
| 
 | |
| 	/* Map max_hz to QMR[BAUD] */
 | |
| 	if (max_hz == 0) /* Go as fast as possible */
 | |
| 		dev->qmr = 2u;
 | |
| 	else /* Get the closest baud rate */
 | |
| 		dev->qmr = clamp(((gd->bus_clk >> 2) + max_hz - 1)/max_hz,
 | |
| 					2u, 255u);
 | |
| 
 | |
| 	/* Map mode to QMR[CPOL] and QMR[CPHA] */
 | |
| 	if (mode & SPI_CPOL)
 | |
| 		dev->qmr |= QSPI_QMR_CPOL;
 | |
| 
 | |
| 	if (mode & SPI_CPHA)
 | |
| 		dev->qmr |= QSPI_QMR_CPHA;
 | |
| 
 | |
| 	/* Hardcode bit length to 8 bit per transter */
 | |
| 	dev->qmr |= QSPI_QMR_BITS_8;
 | |
| 
 | |
| 	/* Set QMR[MSTR] to enable QSPI as master */
 | |
| 	dev->qmr |= QSPI_QMR_MSTR;
 | |
| 
 | |
| 	/*
 | |
| 	 * Set QCR and QWR to default values for spi flash operation.
 | |
| 	 * If more custom QCR and QRW are needed, overload mode variable
 | |
| 	 */
 | |
| 	dev->qcr = (QSPI_QDR_CONT | QSPI_QDR_BITSE);
 | |
| 
 | |
| 	if (!(mode & SPI_CS_HIGH))
 | |
| 		dev->qwr |= QSPI_QWR_CSIV;
 | |
| 
 | |
| 	return &dev->slave;
 | |
| }
 | |
| 
 | |
| /* Transfer 8 bit at a time */
 | |
| int spi_xfer(struct spi_slave *slave, unsigned int bitlen, const void *dout,
 | |
| 	     void *din, unsigned long flags)
 | |
| {
 | |
| 	struct cf_qspi_slave *dev = to_cf_qspi_slave(slave);
 | |
| 	volatile qspi_t *qspi = dev->regs;
 | |
| 	u8 *txbuf = (u8 *)dout;
 | |
| 	u8 *rxbuf = (u8 *)din;
 | |
| 	u32 count = DIV_ROUND_UP(bitlen, 8);
 | |
| 	u32 n, i = 0;
 | |
| 
 | |
| 	/* Sanitize arguments */
 | |
| 	if (slave == NULL) {
 | |
| 		printf("%s: NULL slave ptr\n", __func__);
 | |
| 		return -1;
 | |
| 	}
 | |
| 
 | |
| 	if (flags & SPI_XFER_BEGIN)
 | |
| 		spi_cs_activate(slave);
 | |
| 
 | |
| 	/* There is something to send, lets process it. spi_xfer is also called
 | |
| 	 * just to toggle chip select, so bitlen of 0 is valid */
 | |
| 	if (count > 0) {
 | |
| 		/*
 | |
| 		* NOTE: Since chip select is driven as a bit-bang-ed GPIO
 | |
| 		* using spi_cs_activate() and spi_cs_deactivate(),
 | |
| 		* the chip select settings inside the controller
 | |
| 		* (i.e. QCR[CONT] and QWR[CSIV]) are moot. The bits are set to
 | |
| 		* keep the controller settings consistent with the actual
 | |
| 		* operation of the bus.
 | |
| 		*/
 | |
| 
 | |
| 		/* Write the slave device's settings for the controller.*/
 | |
| 		write_qmr(qspi, dev->qmr);
 | |
| 		write_qwr(qspi, dev->qwr);
 | |
| 
 | |
| 		/* Limit transfer to 16 at a time */
 | |
| 		n = min(count, 16u);
 | |
| 		do {
 | |
| 			/* Setup queue end point */
 | |
| 			write_qwr(qspi, ((read_qwr(qspi) & QSPI_QWR_ENDQP_MASK)
 | |
| 				| QSPI_QWR_ENDQP((n-1))));
 | |
| 
 | |
| 			/* Write Command RAM */
 | |
| 			write_qar(qspi, QSPI_QAR_CMD);
 | |
| 			for (i = 0; i < n; ++i)
 | |
| 				write_qdr(qspi, dev->qcr);
 | |
| 
 | |
| 			/* Write TxBuf, if none given, fill with ZEROes */
 | |
| 			write_qar(qspi, QSPI_QAR_TRANS);
 | |
| 			if (txbuf) {
 | |
| 				for (i = 0; i < n; ++i)
 | |
| 					write_qdr(qspi, *txbuf++);
 | |
| 			} else {
 | |
| 				for (i = 0; i < n; ++i)
 | |
| 					write_qdr(qspi, 0);
 | |
| 			}
 | |
| 
 | |
| 			/* Clear QIR[SPIF] by writing a 1 to it */
 | |
| 			write_qir(qspi, read_qir(qspi) | QSPI_QIR_SPIF);
 | |
| 			/* Set QDLYR[SPE] to start sending */
 | |
| 			write_qdlyr(qspi, read_qdlyr(qspi) | QSPI_QDLYR_SPE);
 | |
| 
 | |
| 			/* Poll QIR[SPIF] for transfer completion */
 | |
| 			while ((read_qir(qspi) & QSPI_QIR_SPIF) != 1)
 | |
| 				udelay(1);
 | |
| 
 | |
| 			/* If given read RxBuf, load data to it */
 | |
| 			if (rxbuf) {
 | |
| 				write_qar(qspi, QSPI_QAR_RECV);
 | |
| 				for (i = 0; i < n; ++i)
 | |
| 					*rxbuf++ = read_qdr(qspi);
 | |
| 			}
 | |
| 
 | |
| 			/* Decrement count */
 | |
| 			count -= n;
 | |
| 		} while (count);
 | |
| 	}
 | |
| 
 | |
| 	if (flags & SPI_XFER_END)
 | |
| 		spi_cs_deactivate(slave);
 | |
| 
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| /* Each MCF CPU may have different pin assignments for chip selects. */
 | |
| #if defined(CONFIG_M5271)
 | |
| /* Assert chip select, val = [1|0] , dir = out, mode = GPIO */
 | |
| void cfspi_cs_activate(uint bus, uint cs, uint cs_active_high)
 | |
| {
 | |
| 	debug("%s: bus %d cs %d cs_active_high %d\n",
 | |
| 		__func__, bus, cs, cs_active_high);
 | |
| 
 | |
| 	switch (cs) {
 | |
| 	case 0: /* QSPI_CS[0] = PQSPI[3] */
 | |
| 		if (cs_active_high)
 | |
| 			mbar_writeByte(MCF_GPIO_PPDSDR_QSPI, 0x08);
 | |
| 		else
 | |
| 			mbar_writeByte(MCF_GPIO_PCLRR_QSPI, 0xF7);
 | |
| 
 | |
| 		mbar_writeByte(MCF_GPIO_PDDR_QSPI,
 | |
| 			mbar_readByte(MCF_GPIO_PDDR_QSPI) | 0x08);
 | |
| 
 | |
| 		mbar_writeByte(MCF_GPIO_PAR_QSPI,
 | |
| 			mbar_readByte(MCF_GPIO_PAR_QSPI) & 0xDF);
 | |
| 		break;
 | |
| 	case 1: /* QSPI_CS[1] = PQSPI[4] */
 | |
| 		if (cs_active_high)
 | |
| 			mbar_writeByte(MCF_GPIO_PPDSDR_QSPI, 0x10);
 | |
| 		else
 | |
| 			mbar_writeByte(MCF_GPIO_PCLRR_QSPI, 0xEF);
 | |
| 
 | |
| 		mbar_writeByte(MCF_GPIO_PDDR_QSPI,
 | |
| 			mbar_readByte(MCF_GPIO_PDDR_QSPI) | 0x10);
 | |
| 
 | |
| 		mbar_writeByte(MCF_GPIO_PAR_QSPI,
 | |
| 			mbar_readByte(MCF_GPIO_PAR_QSPI) & 0x3F);
 | |
| 		break;
 | |
| 	case 2: /* QSPI_CS[2] = PTIMER[7] */
 | |
| 		if (cs_active_high)
 | |
| 			mbar_writeByte(MCF_GPIO_PPDSDR_TIMER, 0x80);
 | |
| 		else
 | |
| 			mbar_writeByte(MCF_GPIO_PCLRR_TIMER, 0x7F);
 | |
| 
 | |
| 		mbar_writeByte(MCF_GPIO_PDDR_TIMER,
 | |
| 			mbar_readByte(MCF_GPIO_PDDR_TIMER) | 0x80);
 | |
| 
 | |
| 		mbar_writeShort(MCF_GPIO_PAR_TIMER,
 | |
| 			mbar_readShort(MCF_GPIO_PAR_TIMER) & 0x3FFF);
 | |
| 		break;
 | |
| 	case 3: /* QSPI_CS[3] = PTIMER[3] */
 | |
| 		if (cs_active_high)
 | |
| 			mbar_writeByte(MCF_GPIO_PPDSDR_TIMER, 0x08);
 | |
| 		else
 | |
| 			mbar_writeByte(MCF_GPIO_PCLRR_TIMER, 0xF7);
 | |
| 
 | |
| 		mbar_writeByte(MCF_GPIO_PDDR_TIMER,
 | |
| 			mbar_readByte(MCF_GPIO_PDDR_TIMER) | 0x08);
 | |
| 
 | |
| 		mbar_writeShort(MCF_GPIO_PAR_TIMER,
 | |
| 			mbar_readShort(MCF_GPIO_PAR_TIMER) & 0xFF3F);
 | |
| 		break;
 | |
| 	}
 | |
| }
 | |
| 
 | |
| /* Deassert chip select, val = [1|0], dir = in, mode = GPIO
 | |
|  * direction set as IN to undrive the pin, external pullup/pulldown will bring
 | |
|  * bus to deassert state.
 | |
|  */
 | |
| void cfspi_cs_deactivate(uint bus, uint cs, uint cs_active_high)
 | |
| {
 | |
| 	debug("%s: bus %d cs %d cs_active_high %d\n",
 | |
| 		__func__, bus, cs, cs_active_high);
 | |
| 
 | |
| 	switch (cs) {
 | |
| 	case 0: /* QSPI_CS[0] = PQSPI[3] */
 | |
| 		if (cs_active_high)
 | |
| 			mbar_writeByte(MCF_GPIO_PCLRR_QSPI, 0xF7);
 | |
| 		else
 | |
| 			mbar_writeByte(MCF_GPIO_PPDSDR_QSPI, 0x08);
 | |
| 
 | |
| 		mbar_writeByte(MCF_GPIO_PDDR_QSPI,
 | |
| 			mbar_readByte(MCF_GPIO_PDDR_QSPI) & 0xF7);
 | |
| 
 | |
| 		mbar_writeByte(MCF_GPIO_PAR_QSPI,
 | |
| 			mbar_readByte(MCF_GPIO_PAR_QSPI) & 0xDF);
 | |
| 		break;
 | |
| 	case 1: /* QSPI_CS[1] = PQSPI[4] */
 | |
| 		if (cs_active_high)
 | |
| 			mbar_writeByte(MCF_GPIO_PCLRR_QSPI, 0xEF);
 | |
| 		else
 | |
| 			mbar_writeByte(MCF_GPIO_PPDSDR_QSPI, 0x10);
 | |
| 
 | |
| 		mbar_writeByte(MCF_GPIO_PDDR_QSPI,
 | |
| 			mbar_readByte(MCF_GPIO_PDDR_QSPI) & 0xEF);
 | |
| 
 | |
| 		mbar_writeByte(MCF_GPIO_PAR_QSPI,
 | |
| 			mbar_readByte(MCF_GPIO_PAR_QSPI) & 0x3F);
 | |
| 		break;
 | |
| 	case 2: /* QSPI_CS[2] = PTIMER[7] */
 | |
| 		if (cs_active_high)
 | |
| 			mbar_writeByte(MCF_GPIO_PCLRR_TIMER, 0x7F);
 | |
| 		else
 | |
| 			mbar_writeByte(MCF_GPIO_PPDSDR_TIMER, 0x80);
 | |
| 
 | |
| 		mbar_writeByte(MCF_GPIO_PDDR_TIMER,
 | |
| 			mbar_readByte(MCF_GPIO_PDDR_TIMER) & 0x7F);
 | |
| 
 | |
| 		mbar_writeShort(MCF_GPIO_PAR_TIMER,
 | |
| 			mbar_readShort(MCF_GPIO_PAR_TIMER) & 0x3FFF);
 | |
| 		break;
 | |
| 	case 3: /* QSPI_CS[3] = PTIMER[3] */
 | |
| 		if (cs_active_high)
 | |
| 			mbar_writeByte(MCF_GPIO_PCLRR_TIMER, 0xF7);
 | |
| 		else
 | |
| 			mbar_writeByte(MCF_GPIO_PPDSDR_TIMER, 0x08);
 | |
| 
 | |
| 		mbar_writeByte(MCF_GPIO_PDDR_TIMER,
 | |
| 			mbar_readByte(MCF_GPIO_PDDR_TIMER) & 0xF7);
 | |
| 
 | |
| 		mbar_writeShort(MCF_GPIO_PAR_TIMER,
 | |
| 			mbar_readShort(MCF_GPIO_PAR_TIMER) & 0xFF3F);
 | |
| 		break;
 | |
| 	}
 | |
| }
 | |
| #endif /* CONFIG_M5271 */
 |