296 lines
		
	
	
		
			7.1 KiB
		
	
	
	
		
			C
		
	
	
	
			
		
		
	
	
			296 lines
		
	
	
		
			7.1 KiB
		
	
	
	
		
			C
		
	
	
	
| /*
 | |
|  * Copyright (C) 2015 Marvell International Ltd.
 | |
|  *
 | |
|  * Copyright (C) 2016 Stefan Roese <sr@denx.de>
 | |
|  *
 | |
|  * SPDX-License-Identifier:	GPL-2.0+
 | |
|  */
 | |
| 
 | |
| #include <common.h>
 | |
| #include <dm.h>
 | |
| #include <malloc.h>
 | |
| #include <spi.h>
 | |
| #include <wait_bit.h>
 | |
| #include <asm/io.h>
 | |
| 
 | |
| DECLARE_GLOBAL_DATA_PTR;
 | |
| 
 | |
| #define MVEBU_SPI_A3700_XFER_RDY		BIT(1)
 | |
| #define MVEBU_SPI_A3700_FIFO_FLUSH		BIT(9)
 | |
| #define MVEBU_SPI_A3700_BYTE_LEN		BIT(5)
 | |
| #define MVEBU_SPI_A3700_CLK_PHA			BIT(6)
 | |
| #define MVEBU_SPI_A3700_CLK_POL			BIT(7)
 | |
| #define MVEBU_SPI_A3700_FIFO_EN			BIT(17)
 | |
| #define MVEBU_SPI_A3700_SPI_EN_0		BIT(16)
 | |
| #define MVEBU_SPI_A3700_CLK_PRESCALE_BIT	0
 | |
| #define MVEBU_SPI_A3700_CLK_PRESCALE_MASK	\
 | |
| 	(0x1f << MVEBU_SPI_A3700_CLK_PRESCALE_BIT)
 | |
| 
 | |
| /* SPI registers */
 | |
| struct spi_reg {
 | |
| 	u32 ctrl;	/* 0x10600 */
 | |
| 	u32 cfg;	/* 0x10604 */
 | |
| 	u32 dout;	/* 0x10608 */
 | |
| 	u32 din;	/* 0x1060c */
 | |
| };
 | |
| 
 | |
| struct mvebu_spi_platdata {
 | |
| 	struct spi_reg *spireg;
 | |
| 	unsigned int frequency;
 | |
| 	unsigned int clock;
 | |
| };
 | |
| 
 | |
| static void spi_cs_activate(struct spi_reg *reg, int cs)
 | |
| {
 | |
| 	setbits_le32(®->ctrl, MVEBU_SPI_A3700_SPI_EN_0 << cs);
 | |
| }
 | |
| 
 | |
| static void spi_cs_deactivate(struct spi_reg *reg, int cs)
 | |
| {
 | |
| 	clrbits_le32(®->ctrl, MVEBU_SPI_A3700_SPI_EN_0 << cs);
 | |
| }
 | |
| 
 | |
| /**
 | |
|  * spi_legacy_shift_byte() - triggers the real SPI transfer
 | |
|  * @bytelen:	Indicate how many bytes to transfer.
 | |
|  * @dout:	Buffer address of what to send.
 | |
|  * @din:	Buffer address of where to receive.
 | |
|  *
 | |
|  * This function triggers the real SPI transfer in legacy mode. It
 | |
|  * will shift out char buffer from @dout, and shift in char buffer to
 | |
|  * @din, if necessary.
 | |
|  *
 | |
|  * This function assumes that only one byte is shifted at one time.
 | |
|  * However, it is not its responisbility to set the transfer type to
 | |
|  * one-byte. Also, it does not guarantee that it will work if transfer
 | |
|  * type becomes two-byte. See spi_set_legacy() for details.
 | |
|  *
 | |
|  * In legacy mode, simply write to the SPI_DOUT register will trigger
 | |
|  * the transfer.
 | |
|  *
 | |
|  * If @dout == NULL, which means no actual data needs to be sent out,
 | |
|  * then the function will shift out 0x00 in order to shift in data.
 | |
|  * The XFER_RDY flag is checked every time before accessing SPI_DOUT
 | |
|  * and SPI_DIN register.
 | |
|  *
 | |
|  * The number of transfers to be triggerred is decided by @bytelen.
 | |
|  *
 | |
|  * Return:	0 - cool
 | |
|  *		-ETIMEDOUT - XFER_RDY flag timeout
 | |
|  */
 | |
| static int spi_legacy_shift_byte(struct spi_reg *reg, unsigned int bytelen,
 | |
| 				 const void *dout, void *din)
 | |
| {
 | |
| 	const u8 *dout_8;
 | |
| 	u8 *din_8;
 | |
| 	int ret;
 | |
| 
 | |
| 	/* Use 0x00 as dummy dout */
 | |
| 	const u8 dummy_dout = 0x0;
 | |
| 	u32 pending_dout = 0x0;
 | |
| 
 | |
| 	/* dout_8: pointer of current dout */
 | |
| 	dout_8 = dout;
 | |
| 	/* din_8: pointer of current din */
 | |
| 	din_8 = din;
 | |
| 
 | |
| 	while (bytelen) {
 | |
| 		ret = wait_for_bit(__func__, ®->ctrl,
 | |
| 				   MVEBU_SPI_A3700_XFER_RDY, true, 100, false);
 | |
| 		if (ret)
 | |
| 			return ret;
 | |
| 
 | |
| 		if (dout)
 | |
| 			pending_dout = (u32)*dout_8;
 | |
| 		else
 | |
| 			pending_dout = (u32)dummy_dout;
 | |
| 
 | |
| 		/* Trigger the xfer */
 | |
| 		writel(pending_dout, ®->dout);
 | |
| 
 | |
| 		if (din) {
 | |
| 			ret = wait_for_bit(__func__, ®->ctrl,
 | |
| 					   MVEBU_SPI_A3700_XFER_RDY,
 | |
| 					   true, 100, false);
 | |
| 			if (ret)
 | |
| 				return ret;
 | |
| 
 | |
| 			/* Read what is transferred in */
 | |
| 			*din_8 = (u8)readl(®->din);
 | |
| 		}
 | |
| 
 | |
| 		/* Don't increment the current pointer if NULL */
 | |
| 		if (dout)
 | |
| 			dout_8++;
 | |
| 		if (din)
 | |
| 			din_8++;
 | |
| 
 | |
| 		bytelen--;
 | |
| 	}
 | |
| 
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| static int mvebu_spi_xfer(struct udevice *dev, unsigned int bitlen,
 | |
| 			  const void *dout, void *din, unsigned long flags)
 | |
| {
 | |
| 	struct udevice *bus = dev->parent;
 | |
| 	struct mvebu_spi_platdata *plat = dev_get_platdata(bus);
 | |
| 	struct spi_reg *reg = plat->spireg;
 | |
| 	unsigned int bytelen;
 | |
| 	int ret;
 | |
| 
 | |
| 	bytelen = bitlen / 8;
 | |
| 
 | |
| 	if (dout && din)
 | |
| 		debug("This is a duplex transfer.\n");
 | |
| 
 | |
| 	/* Activate CS */
 | |
| 	if (flags & SPI_XFER_BEGIN) {
 | |
| 		debug("SPI: activate cs.\n");
 | |
| 		spi_cs_activate(reg, spi_chip_select(dev));
 | |
| 	}
 | |
| 
 | |
| 	/* Send and/or receive */
 | |
| 	if (dout || din) {
 | |
| 		ret = spi_legacy_shift_byte(reg, bytelen, dout, din);
 | |
| 		if (ret)
 | |
| 			return ret;
 | |
| 	}
 | |
| 
 | |
| 	/* Deactivate CS */
 | |
| 	if (flags & SPI_XFER_END) {
 | |
| 		ret = wait_for_bit(__func__, ®->ctrl,
 | |
| 				   MVEBU_SPI_A3700_XFER_RDY, true, 100, false);
 | |
| 		if (ret)
 | |
| 			return ret;
 | |
| 
 | |
| 		debug("SPI: deactivate cs.\n");
 | |
| 		spi_cs_deactivate(reg, spi_chip_select(dev));
 | |
| 	}
 | |
| 
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| static int mvebu_spi_set_speed(struct udevice *bus, uint hz)
 | |
| {
 | |
| 	struct mvebu_spi_platdata *plat = dev_get_platdata(bus);
 | |
| 	struct spi_reg *reg = plat->spireg;
 | |
| 	u32 data;
 | |
| 
 | |
| 	data = readl(®->cfg);
 | |
| 
 | |
| 	/* Set Prescaler */
 | |
| 	data &= ~MVEBU_SPI_A3700_CLK_PRESCALE_MASK;
 | |
| 
 | |
| 	/* Calculate Prescaler = (spi_input_freq / spi_max_freq) */
 | |
| 	if (hz > plat->frequency)
 | |
| 		hz = plat->frequency;
 | |
| 	data |= plat->clock / hz;
 | |
| 
 | |
| 	writel(data, ®->cfg);
 | |
| 
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| static int mvebu_spi_set_mode(struct udevice *bus, uint mode)
 | |
| {
 | |
| 	struct mvebu_spi_platdata *plat = dev_get_platdata(bus);
 | |
| 	struct spi_reg *reg = plat->spireg;
 | |
| 
 | |
| 	/*
 | |
| 	 * Set SPI polarity
 | |
| 	 * 0: Serial interface clock is low when inactive
 | |
| 	 * 1: Serial interface clock is high when inactive
 | |
| 	 */
 | |
| 	if (mode & SPI_CPOL)
 | |
| 		setbits_le32(®->cfg, MVEBU_SPI_A3700_CLK_POL);
 | |
| 	else
 | |
| 		clrbits_le32(®->cfg, MVEBU_SPI_A3700_CLK_POL);
 | |
| 	if (mode & SPI_CPHA)
 | |
| 		setbits_le32(®->cfg, MVEBU_SPI_A3700_CLK_PHA);
 | |
| 	else
 | |
| 		clrbits_le32(®->cfg, MVEBU_SPI_A3700_CLK_PHA);
 | |
| 
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| static int mvebu_spi_probe(struct udevice *bus)
 | |
| {
 | |
| 	struct mvebu_spi_platdata *plat = dev_get_platdata(bus);
 | |
| 	struct spi_reg *reg = plat->spireg;
 | |
| 	u32 data;
 | |
| 	int ret;
 | |
| 
 | |
| 	/*
 | |
| 	 * Settings SPI controller to be working in legacy mode, which
 | |
| 	 * means use only DO pin (I/O 1) for Data Out, and DI pin (I/O 0)
 | |
| 	 * for Data In.
 | |
| 	 */
 | |
| 
 | |
| 	/* Flush read/write FIFO */
 | |
| 	data = readl(®->cfg);
 | |
| 	writel(data | MVEBU_SPI_A3700_FIFO_FLUSH, ®->cfg);
 | |
| 	ret = wait_for_bit(__func__, ®->cfg, MVEBU_SPI_A3700_FIFO_FLUSH,
 | |
| 			   false, 1000, false);
 | |
| 	if (ret)
 | |
| 		return ret;
 | |
| 
 | |
| 	/* Disable FIFO mode */
 | |
| 	data &= ~MVEBU_SPI_A3700_FIFO_EN;
 | |
| 
 | |
| 	/* Always shift 1 byte at a time */
 | |
| 	data &= ~MVEBU_SPI_A3700_BYTE_LEN;
 | |
| 
 | |
| 	writel(data, ®->cfg);
 | |
| 
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| static int mvebu_spi_ofdata_to_platdata(struct udevice *bus)
 | |
| {
 | |
| 	struct mvebu_spi_platdata *plat = dev_get_platdata(bus);
 | |
| 
 | |
| 	plat->spireg = (struct spi_reg *)devfdt_get_addr(bus);
 | |
| 
 | |
| 	/*
 | |
| 	 * FIXME
 | |
| 	 * Right now, mvebu does not have a clock infrastructure in U-Boot
 | |
| 	 * which should be used to query the input clock to the SPI
 | |
| 	 * controller. Once this clock driver is integrated into U-Boot
 | |
| 	 * it should be used to read the input clock and the DT property
 | |
| 	 * can be removed.
 | |
| 	 */
 | |
| 	plat->clock = fdtdec_get_int(gd->fdt_blob, dev_of_offset(bus),
 | |
| 				     "clock-frequency", 160000);
 | |
| 	plat->frequency = fdtdec_get_int(gd->fdt_blob, dev_of_offset(bus),
 | |
| 					 "spi-max-frequency", 40000);
 | |
| 
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| static const struct dm_spi_ops mvebu_spi_ops = {
 | |
| 	.xfer		= mvebu_spi_xfer,
 | |
| 	.set_speed	= mvebu_spi_set_speed,
 | |
| 	.set_mode	= mvebu_spi_set_mode,
 | |
| 	/*
 | |
| 	 * cs_info is not needed, since we require all chip selects to be
 | |
| 	 * in the device tree explicitly
 | |
| 	 */
 | |
| };
 | |
| 
 | |
| static const struct udevice_id mvebu_spi_ids[] = {
 | |
| 	{ .compatible = "marvell,armada-3700-spi" },
 | |
| 	{ }
 | |
| };
 | |
| 
 | |
| U_BOOT_DRIVER(mvebu_spi) = {
 | |
| 	.name = "mvebu_spi",
 | |
| 	.id = UCLASS_SPI,
 | |
| 	.of_match = mvebu_spi_ids,
 | |
| 	.ops = &mvebu_spi_ops,
 | |
| 	.ofdata_to_platdata = mvebu_spi_ofdata_to_platdata,
 | |
| 	.platdata_auto_alloc_size = sizeof(struct mvebu_spi_platdata),
 | |
| 	.probe = mvebu_spi_probe,
 | |
| };
 |