Message ID | 1515051455-9005-1-git-send-email-sivadur@xilinx.com |
---|---|
State | Superseded |
Delegated to: | Michal Simek |
Headers | show |
Series | [U-Boot,v2,1/2] spi: zynqmp_qspi: Add support for ZynqMP qspi driver | expand |
Hi Jagan, Ping! Thanks, Siva > -----Original Message----- > From: Siva Durga Prasad Paladugu [mailto:siva.durga.paladugu@xilinx.com] > Sent: Thursday, January 04, 2018 1:08 PM > To: u-boot@lists.denx.de > Cc: jagannadh.teki@gmail.com; Siva Durga Prasad Paladugu > <sivadur@xilinx.com> > Subject: [PATCH v2 1/2] spi: zynqmp_qspi: Add support for ZynqMP qspi > driver > > This patch adds qspi driver support for ZynqMP SoC. This driver is > responsible for communicating with qspi flash devices. > > Signed-off-by: Siva Durga Prasad Paladugu <sivadur@xilinx.com> > --- > Changes from v1: > - Rebased on top of latest master > - Moved macro definitions to .h file as per comment > - Fixed magic values with macros as per comment > --- > arch/arm/cpu/armv8/zynqmp/Kconfig | 7 + > arch/arm/include/asm/arch-zynqmp/zynqmp_qspi.h | 154 ++++++ > drivers/spi/Makefile | 1 + > drivers/spi/zynqmp_qspi.c | 678 > +++++++++++++++++++++++++ > 4 files changed, 840 insertions(+) > create mode 100644 arch/arm/include/asm/arch-zynqmp/zynqmp_qspi.h > create mode 100644 drivers/spi/zynqmp_qspi.c > > diff --git a/arch/arm/cpu/armv8/zynqmp/Kconfig > b/arch/arm/cpu/armv8/zynqmp/Kconfig > index 3f922b4..2fe4f71 100644 > --- a/arch/arm/cpu/armv8/zynqmp/Kconfig > +++ b/arch/arm/cpu/armv8/zynqmp/Kconfig > @@ -65,6 +65,13 @@ config PMUFW_INIT_FILE > Include external PMUFW (Platform Management Unit FirmWare) > to > a Xilinx bootable image (boot.bin). > > +config ZYNQMP_QSPI > + bool "Configure ZynqMP QSPI" > + select DM_SPI > + help > + This option is used to enable ZynqMP QSPI controller driver which > + is used to communicate with qspi flash devices. > + > config ZYNQMP_USB > bool "Configure ZynqMP USB" > > diff --git a/arch/arm/include/asm/arch-zynqmp/zynqmp_qspi.h > b/arch/arm/include/asm/arch-zynqmp/zynqmp_qspi.h > new file mode 100644 > index 0000000..5e2926e > --- /dev/null > +++ b/arch/arm/include/asm/arch-zynqmp/zynqmp_qspi.h > @@ -0,0 +1,154 @@ > +/* > + * (C) Copyright 2014 - 2015 Xilinx > + * > + * Xilinx ZynqMP Quad-SPI(QSPI) controller driver (master mode only) > + * > + * SPDX-License-Identifier: GPL-2.0+ > + */ > + > +#ifndef _ASM_ARCH_ZYNQMP_QSPI_H_ > +#define _ASM_ARCH_ZYNQMP_QSPI_H_ > + > +#define ZYNQMP_QSPI_GFIFO_STRT_MODE_MASK BIT(29) > +#define ZYNQMP_QSPI_CONFIG_MODE_EN_MASK (3 << 30) > +#define ZYNQMP_QSPI_CONFIG_DMA_MODE (2 << 30) > +#define ZYNQMP_QSPI_CONFIG_CPHA_MASK BIT(2) > +#define ZYNQMP_QSPI_CONFIG_CPOL_MASK BIT(1) > + > +/* QSPI MIO's count for different connection topologies */ > +#define ZYNQMP_QSPI_MIO_NUM_QSPI0 6 > +#define ZYNQMP_QSPI_MIO_NUM_QSPI1 5 > +#define ZYNQMP_QSPI_MIO_NUM_QSPI1_CS 1 > + > +/* > + * QSPI Interrupt Registers bit Masks > + * > + * All the four interrupt registers (Status/Mask/Enable/Disable) have > +the same > + * bit definitions. > + */ > +#define ZYNQMP_QSPI_IXR_TXNFULL_MASK 0x00000004 /* QSPI TX FIFO > Overflow */ > +#define ZYNQMP_QSPI_IXR_TXFULL_MASK 0x00000008 /* QSPI TX FIFO > is full */ > +#define ZYNQMP_QSPI_IXR_RXNEMTY_MASK 0x00000010 /* QSPI > RX FIFO Not Empty */ > +#define ZYNQMP_QSPI_IXR_GFEMTY_MASK 0x00000080 /* QSPI Generic > FIFO Empty */ > +#define ZYNQMP_QSPI_IXR_ALL_MASK > (ZYNQMP_QSPI_IXR_TXNFULL_MASK | \ > + > ZYNQMP_QSPI_IXR_RXNEMTY_MASK) > + > +/* > + * QSPI Enable Register bit Masks > + * > + * This register is used to enable or disable the QSPI controller */ > +#define ZYNQMP_QSPI_ENABLE_ENABLE_MASK 0x00000001 /* QSPI > Enable Bit Mask */ > + > +#define ZYNQMP_QSPI_GFIFO_LOW_BUS BIT(14) > +#define ZYNQMP_QSPI_GFIFO_CS_LOWER BIT(12) > +#define ZYNQMP_QSPI_GFIFO_UP_BUS BIT(15) > +#define ZYNQMP_QSPI_GFIFO_CS_UPPER BIT(13) > +#define ZYNQMP_QSPI_SPI_MODE_QSPI (3 << 10) > +#define ZYNQMP_QSPI_SPI_MODE_SPI BIT(10) > +#define ZYNQMP_QSPI_SPI_MODE_DUAL_SPI (2 << 10) > +#define ZYNQMP_QSPI_IMD_DATA_CS_ASSERT 5 > +#define ZYNQMP_QSPI_IMD_DATA_CS_DEASSERT 5 > +#define ZYNQMP_QSPI_GFIFO_TX BIT(16) > +#define ZYNQMP_QSPI_GFIFO_RX BIT(17) > +#define ZYNQMP_QSPI_GFIFO_STRIPE_MASK BIT(18) > +#define ZYNQMP_QSPI_GFIFO_IMD_MASK 0xFF > +#define ZYNQMP_QSPI_GFIFO_EXP_MASK BIT(9) > +#define ZYNQMP_QSPI_GFIFO_DATA_XFR_MASK BIT(8) > +#define ZYNQMP_QSPI_STRT_GEN_FIFO BIT(28) > +#define ZYNQMP_QSPI_GEN_FIFO_STRT_MOD BIT(29) > +#define ZYNQMP_QSPI_GFIFO_WP_HOLD BIT(19) > +#define ZYNQMP_QSPI_BAUD_DIV_MASK (7 << 3) > +#define ZYNQMP_QSPI_DFLT_BAUD_RATE_DIV BIT(3) > +#define ZYNQMP_QSPI_GFIFO_ALL_INT_MASK 0xFBE > +#define ZYNQMP_QSPI_DMA_DST_I_STS_DONE BIT(1) > +#define ZYNQMP_QSPI_DMA_DST_I_STS_MASK 0xFE > +#define MODEBITS 0x6 > + > +#define QUAD_OUT_READ_CMD 0x6B > +#define QUAD_PAGE_PROGRAM_CMD 0x32 > +#define DUAL_OUTPUT_FASTRD_CMD 0x3B > + > +#define ZYNQMP_QSPI_GFIFO_SELECT BIT(0) > + > +#define ZYNQMP_QSPI_FIFO_THRESHOLD 1 > + > +#define SPI_XFER_ON_BOTH 0 > +#define SPI_XFER_ON_LOWER 1 > +#define SPI_XFER_ON_UPPER 2 > + > +#define ZYNQMP_QSPI_DMA_ALIGN 0x4 > +#define ZYNQMP_QSPI_MAX_BAUD_RATE_VAL 7 > +#define ZYNQMP_QSPI_DFLT_BAUD_RATE_VAL 2 > + > +#define ZYNQMP_QSPI_TIMEOUT 100000000 > + > +#define GQSPI_BAUD_DIV_SHIFT 2 > +#define GQSPI_LPBK_DLY_ADJ_LPBK_SHIFT 5 > +#define GQSPI_LPBK_DLY_ADJ_DLY_1 0x2 > +#define GQSPI_LPBK_DLY_ADJ_DLY_1_SHIFT 3 > +#define GQSPI_LPBK_DLY_ADJ_DLY_0 0x3 > +#define GQSPI_USE_DATA_DLY 0x1 > +#define GQSPI_USE_DATA_DLY_SHIFT 31 > +#define GQSPI_DATA_DLY_ADJ_VALUE 0x2 > +#define GQSPI_DATA_DLY_ADJ_SHIFT 28 > +#define TAP_DLY_BYPASS_LQSPI_RX_VALUE 0x1 > +#define TAP_DLY_BYPASS_LQSPI_RX_SHIFT 2 > +#define GQSPI_DATA_DLY_ADJ_OFST 0x000001F8 > +#define IOU_TAPDLY_BYPASS_OFST 0xFF180390 > +#define GQSPI_LPBK_DLY_ADJ_USE_LPBK_MASK 0x00000020 > +#define GQSPI_FREQ_40MHZ 40000000 > +#define GQSPI_FREQ_100MHZ 100000000 > +#define GQSPI_FREQ_150MHZ 150000000 > +#define IOU_TAPDLY_BYPASS_MASK 0x7 > + > +#define ZYNQMP_GQSPI_REG_OFFSET 0x100 > +#define ZYNQMP_GQSPI_DMA_REG_OFFSET 0x800 > + > +/* QSPI register offsets */ > +struct zynqmp_qspi_regs { > + u32 confr; /* 0x00 */ > + u32 isr; /* 0x04 */ > + u32 ier; /* 0x08 */ > + u32 idisr; /* 0x0C */ > + u32 imaskr; /* 0x10 */ > + u32 enbr; /* 0x14 */ > + u32 dr; /* 0x18 */ > + u32 txd0r; /* 0x1C */ > + u32 drxr; /* 0x20 */ > + u32 sicr; /* 0x24 */ > + u32 txftr; /* 0x28 */ > + u32 rxftr; /* 0x2C */ > + u32 gpior; /* 0x30 */ > + u32 reserved0; /* 0x34 */ > + u32 lpbkdly; /* 0x38 */ > + u32 reserved1; /* 0x3C */ > + u32 genfifo; /* 0x40 */ > + u32 gqspisel; /* 0x44 */ > + u32 reserved2; /* 0x48 */ > + u32 gqfifoctrl; /* 0x4C */ > + u32 gqfthr; /* 0x50 */ > + u32 gqpollcfg; /* 0x54 */ > + u32 gqpollto; /* 0x58 */ > + u32 gqxfersts; /* 0x5C */ > + u32 gqfifosnap; /* 0x60 */ > + u32 gqrxcpy; /* 0x64 */ > + u32 reserved3[36]; /* 0x68 */ > + u32 gqspidlyadj; /* 0xF8 */ > +}; > + > +struct zynqmp_qspi_dma_regs { > + u32 dmadst; /* 0x00 */ > + u32 dmasize; /* 0x04 */ > + u32 dmasts; /* 0x08 */ > + u32 dmactrl; /* 0x0C */ > + u32 reserved0; /* 0x10 */ > + u32 dmaisr; /* 0x14 */ > + u32 dmaier; /* 0x18 */ > + u32 dmaidr; /* 0x1C */ > + u32 dmaimr; /* 0x20 */ > + u32 dmactrl2; /* 0x24 */ > + u32 dmadstmsb; /* 0x28 */ > +}; > + > +#endif /* _ASM_ARCH_ZYNQMP_QSPI_H_ */ > diff --git a/drivers/spi/Makefile b/drivers/spi/Makefile index > e3184db..9cdd94a 100644 > --- a/drivers/spi/Makefile > +++ b/drivers/spi/Makefile > @@ -50,3 +50,4 @@ obj-$(CONFIG_TI_QSPI) += ti_qspi.o > obj-$(CONFIG_XILINX_SPI) += xilinx_spi.o > obj-$(CONFIG_ZYNQ_SPI) += zynq_spi.o > obj-$(CONFIG_ZYNQ_QSPI) += zynq_qspi.o > +obj-$(CONFIG_ZYNQMP_QSPI) += zynqmp_qspi.o > diff --git a/drivers/spi/zynqmp_qspi.c b/drivers/spi/zynqmp_qspi.c new file > mode 100644 index 0000000..199e704 > --- /dev/null > +++ b/drivers/spi/zynqmp_qspi.c > @@ -0,0 +1,678 @@ > +/* > + * (C) Copyright 2014 - 2015 Xilinx > + * > + * Xilinx ZynqMP Quad-SPI(QSPI) controller driver (master mode only) > + * > + * SPDX-License-Identifier: GPL-2.0 > + */ > + > +#include <common.h> > +#include <malloc.h> > +#include <memalign.h> > +#include <ubi_uboot.h> > +#include <spi.h> > +#include <spi_flash.h> > +#include <asm/io.h> > +#include <asm/arch/hardware.h> > +#include <asm/arch/sys_proto.h> > +#include <asm/arch/clk.h> > +#include "../mtd/spi/sf_internal.h" > +#include <clk.h> > +#include <asm/arch/zynqmp_qspi.h> > + > +DECLARE_GLOBAL_DATA_PTR; > + > +struct zynqmp_qspi_platdata { > + struct zynqmp_qspi_regs *regs; > + struct zynqmp_qspi_dma_regs *dma_regs; > + u32 frequency; > + u32 speed_hz; > + unsigned int tx_rx_mode; > +}; > + > +struct zynqmp_qspi_priv { > + struct zynqmp_qspi_regs *regs; > + struct zynqmp_qspi_dma_regs *dma_regs; > + u8 mode; > + const void *tx_buf; > + void *rx_buf; > + unsigned int len; > + int bytes_to_transfer; > + int bytes_to_receive; > + unsigned int is_inst; > + unsigned int cs_change:1; > +}; > + > +static u8 last_cmd; > + > +static int zynqmp_qspi_ofdata_to_platdata(struct udevice *bus) { > + struct zynqmp_qspi_platdata *plat = bus->platdata; > + u32 mode = 0; > + u32 value; > + int ret; > + struct clk clk; > + unsigned long clock; > + > + debug("%s\n", __func__); > + > + plat->regs = (struct zynqmp_qspi_regs *)(devfdt_get_addr(bus) + > + > ZYNQMP_GQSPI_REG_OFFSET); > + plat->dma_regs = (struct zynqmp_qspi_dma_regs *) > + (devfdt_get_addr(bus) + > ZYNQMP_GQSPI_DMA_REG_OFFSET); > + > + ret = clk_get_by_index(bus, 0, &clk); > + if (ret < 0) { > + dev_err(dev, "failed to get clock\n"); > + return ret; > + } > + > + clock = clk_get_rate(&clk); > + if (IS_ERR_VALUE(clock)) { > + dev_err(dev, "failed to get rate\n"); > + return clock; > + } > + debug("%s: CLK %ld\n", __func__, clock); > + > + ret = clk_enable(&clk); > + if (ret && ret != -ENOSYS) { > + dev_err(dev, "failed to enable clock\n"); > + return ret; > + } > + > + value = dev_read_u32_default(bus, "spi-rx-bus-width", 1); > + switch (value) { > + case 1: > + break; > + case 2: > + mode |= SPI_RX_DUAL; > + break; > + case 4: > + mode |= SPI_RX_QUAD; > + break; > + default: > + printf("Invalid spi-rx-bus-width %d\n", value); > + break; > + } > + > + value = dev_read_u32_default(bus, "spi-tx-bus-width", 1); > + switch (value) { > + case 1: > + break; > + case 2: > + mode |= SPI_TX_DUAL; > + break; > + case 4: > + mode |= SPI_TX_QUAD; > + break; > + default: > + printf("Invalid spi-tx-bus-width %d\n", value); > + break; > + } > + > + plat->tx_rx_mode = mode; > + > + plat->frequency = clock; > + plat->speed_hz = plat->frequency; > + > + return 0; > +} > + > +static void zynqmp_qspi_init_hw(struct zynqmp_qspi_priv *priv) { > + u32 config_reg; > + struct zynqmp_qspi_regs *regs = priv->regs; > + > + writel(ZYNQMP_QSPI_GFIFO_SELECT, ®s->gqspisel); > + writel(ZYNQMP_QSPI_GFIFO_ALL_INT_MASK, ®s->idisr); > + writel(ZYNQMP_QSPI_FIFO_THRESHOLD, ®s->txftr); > + writel(ZYNQMP_QSPI_FIFO_THRESHOLD, ®s->rxftr); > + writel(ZYNQMP_QSPI_GFIFO_ALL_INT_MASK, ®s->isr); > + > + config_reg = readl(®s->confr); > + config_reg &= ~(ZYNQMP_QSPI_GFIFO_STRT_MODE_MASK | > + ZYNQMP_QSPI_CONFIG_MODE_EN_MASK); > + config_reg |= ZYNQMP_QSPI_CONFIG_DMA_MODE | > + ZYNQMP_QSPI_GFIFO_WP_HOLD | > + ZYNQMP_QSPI_DFLT_BAUD_RATE_DIV; > + writel(config_reg, ®s->confr); > + > + writel(ZYNQMP_QSPI_ENABLE_ENABLE_MASK, ®s->enbr); } > + > +static u32 zynqmp_qspi_bus_select(struct zynqmp_qspi_priv *priv) { > + u32 gqspi_fifo_reg = 0; > + > + gqspi_fifo_reg = ZYNQMP_QSPI_GFIFO_LOW_BUS | > + ZYNQMP_QSPI_GFIFO_CS_LOWER; > + > + return gqspi_fifo_reg; > +} > + > +static void zynqmp_qspi_fill_gen_fifo(struct zynqmp_qspi_priv *priv, > + u32 gqspi_fifo_reg) > +{ > + struct zynqmp_qspi_regs *regs = priv->regs; > + u32 reg; > + > + do { > + reg = readl(®s->isr); > + } while (!(reg & ZYNQMP_QSPI_IXR_GFEMTY_MASK)); > + > + writel(gqspi_fifo_reg, ®s->genfifo); } > + > +static void zynqmp_qspi_chipselect(struct zynqmp_qspi_priv *priv, int > +is_on) { > + u32 gqspi_fifo_reg = 0; > + > + if (is_on) { > + gqspi_fifo_reg = zynqmp_qspi_bus_select(priv); > + gqspi_fifo_reg |= ZYNQMP_QSPI_SPI_MODE_SPI | > + ZYNQMP_QSPI_IMD_DATA_CS_ASSERT; > + } else { > + gqspi_fifo_reg = ZYNQMP_QSPI_GFIFO_LOW_BUS; > + gqspi_fifo_reg |= > ZYNQMP_QSPI_IMD_DATA_CS_DEASSERT; > + } > + > + debug("GFIFO_CMD_CS: 0x%x\n", gqspi_fifo_reg); > + > + zynqmp_qspi_fill_gen_fifo(priv, gqspi_fifo_reg); } > + > +void zynqmp_qspi_set_tapdelay(struct udevice *bus, u32 baudrateval) { > + struct zynqmp_qspi_platdata *plat = bus->platdata; > + struct zynqmp_qspi_priv *priv = dev_get_priv(bus); > + struct zynqmp_qspi_regs *regs = priv->regs; > + u32 tapdlybypass = 0, lpbkdlyadj = 0, datadlyadj = 0, clk_rate; > + u32 reqhz = 0; > + > + clk_rate = plat->frequency; > + reqhz = (clk_rate / (GQSPI_BAUD_DIV_SHIFT << baudrateval)); > + > + debug("%s, req_hz:%d, clk_rate:%d, baudrateval:%d\n", > + __func__, reqhz, clk_rate, baudrateval); > + > + if (reqhz < GQSPI_FREQ_40MHZ) { > + zynqmp_mmio_read(IOU_TAPDLY_BYPASS_OFST, > &tapdlybypass); > + tapdlybypass |= (TAP_DLY_BYPASS_LQSPI_RX_VALUE << > + TAP_DLY_BYPASS_LQSPI_RX_SHIFT); > + } else if (reqhz < GQSPI_FREQ_100MHZ) { > + zynqmp_mmio_read(IOU_TAPDLY_BYPASS_OFST, > &tapdlybypass); > + tapdlybypass |= (TAP_DLY_BYPASS_LQSPI_RX_VALUE << > + TAP_DLY_BYPASS_LQSPI_RX_SHIFT); > + lpbkdlyadj = readl(®s->lpbkdly); > + lpbkdlyadj |= (GQSPI_LPBK_DLY_ADJ_USE_LPBK_MASK); > + datadlyadj = readl(®s->gqspidlyadj); > + datadlyadj |= ((GQSPI_USE_DATA_DLY << > GQSPI_USE_DATA_DLY_SHIFT) > + | (GQSPI_DATA_DLY_ADJ_VALUE << > + GQSPI_DATA_DLY_ADJ_SHIFT)); > + } else if (reqhz < GQSPI_FREQ_150MHZ) { > + lpbkdlyadj = readl(®s->lpbkdly); > + lpbkdlyadj |= ((GQSPI_LPBK_DLY_ADJ_USE_LPBK_MASK) | > + GQSPI_LPBK_DLY_ADJ_DLY_0); > + } > + > + zynqmp_mmio_write(IOU_TAPDLY_BYPASS_OFST, > IOU_TAPDLY_BYPASS_MASK, > + tapdlybypass); > + writel(lpbkdlyadj, ®s->lpbkdly); > + writel(datadlyadj, ®s->gqspidlyadj); } > + > +static int zynqmp_qspi_set_speed(struct udevice *bus, uint speed) { > + struct zynqmp_qspi_platdata *plat = bus->platdata; > + struct zynqmp_qspi_priv *priv = dev_get_priv(bus); > + struct zynqmp_qspi_regs *regs = priv->regs; > + u32 confr; > + u8 baud_rate_val = 0; > + > + debug("%s\n", __func__); > + if (speed > plat->frequency) > + speed = plat->frequency; > + > + /* Set the clock frequency */ > + confr = readl(®s->confr); > + if (speed == 0) { > + /* Set baudrate x8, if the freq is 0 */ > + baud_rate_val = ZYNQMP_QSPI_DFLT_BAUD_RATE_VAL; > + } else if (plat->speed_hz != speed) { > + while ((baud_rate_val < 8) && > + ((plat->frequency / > + (2 << baud_rate_val)) > speed)) > + baud_rate_val++; > + > + if (baud_rate_val > ZYNQMP_QSPI_MAX_BAUD_RATE_VAL) > + baud_rate_val = > ZYNQMP_QSPI_DFLT_BAUD_RATE_VAL; > + > + plat->speed_hz = plat->frequency / (2 << baud_rate_val); > + } > + confr &= ~ZYNQMP_QSPI_BAUD_DIV_MASK; > + confr |= (baud_rate_val << 3); > + writel(confr, ®s->confr); > + > + zynqmp_qspi_set_tapdelay(bus, baud_rate_val); > + debug("regs=%p, speed=%d\n", priv->regs, plat->speed_hz); > + > + return 0; > +} > + > +static int zynqmp_qspi_child_pre_probe(struct udevice *bus) { > + struct spi_slave *slave = dev_get_parent_priv(bus); > + struct zynqmp_qspi_platdata *plat = dev_get_platdata(bus- > >parent); > + > + slave->mode = plat->tx_rx_mode; > + > + return 0; > +} > + > +static int zynqmp_qspi_probe(struct udevice *bus) { > + struct zynqmp_qspi_platdata *plat = dev_get_platdata(bus); > + struct zynqmp_qspi_priv *priv = dev_get_priv(bus); > + > + debug("%s: bus:%p, priv:%p\n", __func__, bus, priv); > + > + priv->regs = plat->regs; > + priv->dma_regs = plat->dma_regs; > + > + /* init the zynq spi hw */ > + zynqmp_qspi_init_hw(priv); > + > + return 0; > +} > + > +static int zynqmp_qspi_set_mode(struct udevice *bus, uint mode) { > + struct zynqmp_qspi_priv *priv = dev_get_priv(bus); > + struct zynqmp_qspi_regs *regs = priv->regs; > + u32 confr; > + > + debug("%s\n", __func__); > + /* Set the SPI Clock phase and polarities */ > + confr = readl(®s->confr); > + confr &= ~(ZYNQMP_QSPI_CONFIG_CPHA_MASK | > + ZYNQMP_QSPI_CONFIG_CPOL_MASK); > + > + if (priv->mode & SPI_CPHA) > + confr |= ZYNQMP_QSPI_CONFIG_CPHA_MASK; > + if (priv->mode & SPI_CPOL) > + confr |= ZYNQMP_QSPI_CONFIG_CPOL_MASK; > + > + priv->mode = mode; > + > + debug("regs=%p, mode=%d\n", priv->regs, priv->mode); > + > + return 0; > +} > + > +static int zynqmp_qspi_fill_tx_fifo(struct zynqmp_qspi_priv *priv, u32 > +size) { > + u32 data; > + u32 timeout = ZYNQMP_QSPI_TIMEOUT; > + struct zynqmp_qspi_regs *regs = priv->regs; > + u32 *buf = (u32 *)priv->tx_buf; > + u32 len = size; > + > + debug("TxFIFO: 0x%x, size: 0x%x\n", readl(®s->isr), > + size); > + > + while (size && timeout) { > + if (readl(®s->isr) & > + ZYNQMP_QSPI_IXR_TXNFULL_MASK) { > + if (size >= 4) { > + writel(*buf, ®s->txd0r); > + buf++; > + size -= 4; > + } else { > + switch (size) { > + case 1: > + data = *((u8 *)buf); > + buf += 1; > + data |= 0xFFFFFF00; > + break; > + case 2: > + data = *((u16 *)buf); > + buf += 2; > + data |= 0xFFFF0000; > + break; > + case 3: > + data = *((u16 *)buf); > + buf += 2; > + data |= (*((u8 *)buf) << 16); > + buf += 1; > + data |= 0xFF000000; > + break; > + } > + writel(data, ®s->txd0r); > + size = 0; > + } > + } else { > + udelay(1); > + timeout--; > + } > + } > + if (!timeout) { > + printf("%s: Timeout\n", __func__); > + return -1; > + } > + > + priv->tx_buf += len; > + return 0; > +} > + > +static void zynqmp_qspi_genfifo_cmd(struct zynqmp_qspi_priv *priv) { > + u8 command = 1; > + u32 gen_fifo_cmd; > + u32 bytecount = 0; > + > + while (priv->len) { > + gen_fifo_cmd = zynqmp_qspi_bus_select(priv); > + gen_fifo_cmd |= ZYNQMP_QSPI_GFIFO_TX; > + > + if (command) { > + command = 0; > + last_cmd = *(u8 *)priv->tx_buf; > + } > + > + gen_fifo_cmd |= ZYNQMP_QSPI_SPI_MODE_SPI; > + gen_fifo_cmd |= *(u8 *)priv->tx_buf; > + bytecount++; > + priv->len--; > + priv->tx_buf = (u8 *)priv->tx_buf + 1; > + > + debug("GFIFO_CMD_Cmd = 0x%x\n", gen_fifo_cmd); > + > + zynqmp_qspi_fill_gen_fifo(priv, gen_fifo_cmd); > + } > +} > + > +static u32 zynqmp_qspi_calc_exp(struct zynqmp_qspi_priv *priv, > + u32 *gen_fifo_cmd) > +{ > + u32 expval = 8; > + u32 len; > + > + while (1) { > + if (priv->len > 255) { > + if (priv->len & (1 << expval)) { > + *gen_fifo_cmd &= > ~ZYNQMP_QSPI_GFIFO_IMD_MASK; > + *gen_fifo_cmd |= > ZYNQMP_QSPI_GFIFO_EXP_MASK; > + *gen_fifo_cmd |= expval; > + priv->len -= (1 << expval); > + return expval; > + } > + expval++; > + } else { > + *gen_fifo_cmd &= > ~(ZYNQMP_QSPI_GFIFO_IMD_MASK | > + ZYNQMP_QSPI_GFIFO_EXP_MASK); > + *gen_fifo_cmd |= (u8)priv->len; > + len = (u8)priv->len; > + priv->len = 0; > + return len; > + } > + } > +} > + > +static int zynqmp_qspi_genfifo_fill_tx(struct zynqmp_qspi_priv *priv) { > + u32 gen_fifo_cmd; > + u32 len; > + int ret = 0; > + > + gen_fifo_cmd = zynqmp_qspi_bus_select(priv); > + gen_fifo_cmd |= ZYNQMP_QSPI_GFIFO_TX | > + ZYNQMP_QSPI_GFIFO_DATA_XFR_MASK; > + > + if (last_cmd == QUAD_PAGE_PROGRAM_CMD) > + gen_fifo_cmd |= ZYNQMP_QSPI_SPI_MODE_QSPI; > + else > + gen_fifo_cmd |= ZYNQMP_QSPI_SPI_MODE_SPI; > + > + while (priv->len) { > + len = zynqmp_qspi_calc_exp(priv, &gen_fifo_cmd); > + zynqmp_qspi_fill_gen_fifo(priv, gen_fifo_cmd); > + > + debug("GFIFO_CMD_TX:0x%x\n", gen_fifo_cmd); > + > + if (gen_fifo_cmd & ZYNQMP_QSPI_GFIFO_EXP_MASK) > + ret = zynqmp_qspi_fill_tx_fifo(priv, > + 1 << len); > + else > + ret = zynqmp_qspi_fill_tx_fifo(priv, > + len); > + > + if (ret) > + return ret; > + } > + return ret; > +} > + > +static int zynqmp_qspi_start_dma(struct zynqmp_qspi_priv *priv, > + u32 gen_fifo_cmd, u32 *buf) > +{ > + u32 addr; > + u32 size, len; > + u32 timeout = ZYNQMP_QSPI_TIMEOUT; > + u32 actuallen = priv->len; > + struct zynqmp_qspi_dma_regs *dma_regs = priv->dma_regs; > + > + writel((unsigned long)buf, &dma_regs->dmadst); > + writel(roundup(priv->len, 4), &dma_regs->dmasize); > + writel(ZYNQMP_QSPI_DMA_DST_I_STS_MASK, &dma_regs- > >dmaier); > + addr = (unsigned long)buf; > + size = roundup(priv->len, ARCH_DMA_MINALIGN); > + flush_dcache_range(addr, addr + size); > + > + while (priv->len) { > + len = zynqmp_qspi_calc_exp(priv, &gen_fifo_cmd); > + if (!(gen_fifo_cmd & ZYNQMP_QSPI_GFIFO_EXP_MASK) && > + (len % 4)) { > + gen_fifo_cmd &= ~(0xFF); > + gen_fifo_cmd |= (len / 4 + 1) * 4; > + } > + zynqmp_qspi_fill_gen_fifo(priv, gen_fifo_cmd); > + > + debug("GFIFO_CMD_RX:0x%x\n", gen_fifo_cmd); > + } > + > + while (timeout) { > + if (readl(&dma_regs->dmaisr) & > + ZYNQMP_QSPI_DMA_DST_I_STS_DONE) { > + writel(ZYNQMP_QSPI_DMA_DST_I_STS_DONE, > + &dma_regs->dmaisr); > + break; > + } > + udelay(1); > + timeout--; > + } > + > + debug("buf:0x%lx, rxbuf:0x%lx, *buf:0x%x len: 0x%x\n", > + (unsigned long)buf, (unsigned long)priv->rx_buf, *buf, > + actuallen); > + if (!timeout) { > + printf("DMA Timeout:0x%x\n", readl(&dma_regs->dmaisr)); > + return -1; > + } > + > + if (buf != priv->rx_buf) > + memcpy(priv->rx_buf, buf, actuallen); > + > + return 0; > +} > + > +static int zynqmp_qspi_genfifo_fill_rx(struct zynqmp_qspi_priv *priv) { > + u32 gen_fifo_cmd; > + u32 *buf; > + u32 actuallen = priv->len; > + > + gen_fifo_cmd = zynqmp_qspi_bus_select(priv); > + gen_fifo_cmd |= ZYNQMP_QSPI_GFIFO_RX | > + ZYNQMP_QSPI_GFIFO_DATA_XFR_MASK; > + > + if (last_cmd == QUAD_OUT_READ_CMD) > + gen_fifo_cmd |= ZYNQMP_QSPI_SPI_MODE_QSPI; > + else if (last_cmd == DUAL_OUTPUT_FASTRD_CMD) > + gen_fifo_cmd |= ZYNQMP_QSPI_SPI_MODE_DUAL_SPI; > + else > + gen_fifo_cmd |= ZYNQMP_QSPI_SPI_MODE_SPI; > + > + /* > + * Check if receive buffer is aligned to 4 byte and length > + * is multiples of four byte as we are using dma to receive. > + */ > + if (!((unsigned long)priv->rx_buf & (ZYNQMP_QSPI_DMA_ALIGN - > 1)) && > + !(actuallen % ZYNQMP_QSPI_DMA_ALIGN)) { > + buf = (u32 *)priv->rx_buf; > + return zynqmp_qspi_start_dma(priv, gen_fifo_cmd, buf); > + } > + > + ALLOC_CACHE_ALIGN_BUFFER(u8, tmp, roundup(priv->len, > + > ZYNQMP_QSPI_DMA_ALIGN)); > + buf = (u32 *)tmp; > + return zynqmp_qspi_start_dma(priv, gen_fifo_cmd, buf); } > + > +static int zynqmp_qspi_start_transfer(struct zynqmp_qspi_priv *priv) { > + int ret = 0; > + > + if (priv->is_inst) { > + if (priv->tx_buf) > + zynqmp_qspi_genfifo_cmd(priv); > + else > + ret = -1; > + } else { > + if (priv->tx_buf) > + ret = zynqmp_qspi_genfifo_fill_tx(priv); > + else if (priv->rx_buf) > + ret = zynqmp_qspi_genfifo_fill_rx(priv); > + else > + ret = -1; > + } > + return ret; > +} > + > +static int zynqmp_qspi_transfer(struct zynqmp_qspi_priv *priv) { > + static unsigned int cs_change = 1; > + int status = 0; > + > + debug("%s\n", __func__); > + > + while (1) { > + /* Select the chip if required */ > + if (cs_change) > + zynqmp_qspi_chipselect(priv, 1); > + > + cs_change = priv->cs_change; > + > + if (!priv->tx_buf && !priv->rx_buf && priv->len) { > + status = -1; > + break; > + } > + > + /* Request the transfer */ > + if (priv->len) { > + status = zynqmp_qspi_start_transfer(priv); > + priv->is_inst = 0; > + if (status < 0) > + break; > + } > + > + if (cs_change) > + /* Deselect the chip */ > + zynqmp_qspi_chipselect(priv, 0); > + break; > + } > + > + return status; > +} > + > +static int zynqmp_qspi_claim_bus(struct udevice *dev) { > + struct udevice *bus = dev->parent; > + struct zynqmp_qspi_priv *priv = dev_get_priv(bus); > + struct zynqmp_qspi_regs *regs = priv->regs; > + > + debug("%s\n", __func__); > + writel(ZYNQMP_QSPI_ENABLE_ENABLE_MASK, ®s->enbr); > + > + return 0; > +} > + > +static int zynqmp_qspi_release_bus(struct udevice *dev) { > + struct udevice *bus = dev->parent; > + struct zynqmp_qspi_priv *priv = dev_get_priv(bus); > + struct zynqmp_qspi_regs *regs = priv->regs; > + > + debug("%s\n", __func__); > + writel(~ZYNQMP_QSPI_ENABLE_ENABLE_MASK, ®s->enbr); > + > + return 0; > +} > + > +int zynqmp_qspi_xfer(struct udevice *dev, unsigned int bitlen, const void > *dout, > + void *din, unsigned long flags) > +{ > + struct udevice *bus = dev->parent; > + struct zynqmp_qspi_priv *priv = dev_get_priv(bus); > + > + debug("%s: priv: 0x%08lx bitlen: %d dout: 0x%08lx ", __func__, > + (unsigned long)priv, bitlen, (unsigned long)dout); > + debug("din: 0x%08lx flags: 0x%lx\n", (unsigned long)din, flags); > + > + priv->tx_buf = dout; > + priv->rx_buf = din; > + priv->len = bitlen / 8; > + > + /* > + * Festering sore. > + * Assume that the beginning of a transfer with bits to > + * transmit must contain a device command. > + */ > + if (dout && flags & SPI_XFER_BEGIN) > + priv->is_inst = 1; > + else > + priv->is_inst = 0; > + > + if (flags & SPI_XFER_END) > + priv->cs_change = 1; > + else > + priv->cs_change = 0; > + > + zynqmp_qspi_transfer(priv); > + > + return 0; > +} > + > +static const struct dm_spi_ops zynqmp_qspi_ops = { > + .claim_bus = zynqmp_qspi_claim_bus, > + .release_bus = zynqmp_qspi_release_bus, > + .xfer = zynqmp_qspi_xfer, > + .set_speed = zynqmp_qspi_set_speed, > + .set_mode = zynqmp_qspi_set_mode, > +}; > + > +static const struct udevice_id zynqmp_qspi_ids[] = { > + { .compatible = "xlnx,zynqmp-qspi-1.0" }, > + { } > +}; > + > +U_BOOT_DRIVER(zynqmp_qspi) = { > + .name = "zynqmp_qspi", > + .id = UCLASS_SPI, > + .of_match = zynqmp_qspi_ids, > + .ops = &zynqmp_qspi_ops, > + .ofdata_to_platdata = zynqmp_qspi_ofdata_to_platdata, > + .platdata_auto_alloc_size = sizeof(struct zynqmp_qspi_platdata), > + .priv_auto_alloc_size = sizeof(struct zynqmp_qspi_priv), > + .probe = zynqmp_qspi_probe, > + .child_pre_probe = zynqmp_qspi_child_pre_probe, }; > -- > 2.7.4
On Thu, Jan 4, 2018 at 1:07 PM, Siva Durga Prasad Paladugu <siva.durga.paladugu@xilinx.com> wrote: > This patch adds qspi driver support for ZynqMP SoC. This > driver is responsible for communicating with qspi flash > devices. > > Signed-off-by: Siva Durga Prasad Paladugu <sivadur@xilinx.com> > --- > Changes from v1: > - Rebased on top of latest master > - Moved macro definitions to .h file as per comment > - Fixed magic values with macros as per comment > --- > arch/arm/cpu/armv8/zynqmp/Kconfig | 7 + > arch/arm/include/asm/arch-zynqmp/zynqmp_qspi.h | 154 ++++++ > drivers/spi/Makefile | 1 + > drivers/spi/zynqmp_qspi.c | 678 +++++++++++++++++++++++++ Was this gqspi like linux spi-zynqmp-gqspi.c or different? > 4 files changed, 840 insertions(+) > create mode 100644 arch/arm/include/asm/arch-zynqmp/zynqmp_qspi.h > create mode 100644 drivers/spi/zynqmp_qspi.c > > diff --git a/arch/arm/cpu/armv8/zynqmp/Kconfig b/arch/arm/cpu/armv8/zynqmp/Kconfig > index 3f922b4..2fe4f71 100644 > --- a/arch/arm/cpu/armv8/zynqmp/Kconfig > +++ b/arch/arm/cpu/armv8/zynqmp/Kconfig > @@ -65,6 +65,13 @@ config PMUFW_INIT_FILE > Include external PMUFW (Platform Management Unit FirmWare) to > a Xilinx bootable image (boot.bin). > > +config ZYNQMP_QSPI > + bool "Configure ZynqMP QSPI" > + select DM_SPI > + help > + This option is used to enable ZynqMP QSPI controller driver which > + is used to communicate with qspi flash devices. I've commented this before, what is the reason for adding spi kconfig entry in arch area instead of drivers/spi? > + > config ZYNQMP_USB > bool "Configure ZynqMP USB" > > diff --git a/arch/arm/include/asm/arch-zynqmp/zynqmp_qspi.h b/arch/arm/include/asm/arch-zynqmp/zynqmp_qspi.h > new file mode 100644 > index 0000000..5e2926e > --- /dev/null > +++ b/arch/arm/include/asm/arch-zynqmp/zynqmp_qspi.h > @@ -0,0 +1,154 @@ > +/* > + * (C) Copyright 2014 - 2015 Xilinx > + * > + * Xilinx ZynqMP Quad-SPI(QSPI) controller driver (master mode only) > + * > + * SPDX-License-Identifier: GPL-2.0+ > + */ > + > +#ifndef _ASM_ARCH_ZYNQMP_QSPI_H_ > +#define _ASM_ARCH_ZYNQMP_QSPI_H_ > + > +#define ZYNQMP_QSPI_GFIFO_STRT_MODE_MASK BIT(29) > +#define ZYNQMP_QSPI_CONFIG_MODE_EN_MASK (3 << 30) > +#define ZYNQMP_QSPI_CONFIG_DMA_MODE (2 << 30) > +#define ZYNQMP_QSPI_CONFIG_CPHA_MASK BIT(2) > +#define ZYNQMP_QSPI_CONFIG_CPOL_MASK BIT(1) > + > +/* QSPI MIO's count for different connection topologies */ > +#define ZYNQMP_QSPI_MIO_NUM_QSPI0 6 > +#define ZYNQMP_QSPI_MIO_NUM_QSPI1 5 > +#define ZYNQMP_QSPI_MIO_NUM_QSPI1_CS 1 > + > +/* > + * QSPI Interrupt Registers bit Masks > + * > + * All the four interrupt registers (Status/Mask/Enable/Disable) have the same > + * bit definitions. > + */ > +#define ZYNQMP_QSPI_IXR_TXNFULL_MASK 0x00000004 /* QSPI TX FIFO Overflow */ > +#define ZYNQMP_QSPI_IXR_TXFULL_MASK 0x00000008 /* QSPI TX FIFO is full */ > +#define ZYNQMP_QSPI_IXR_RXNEMTY_MASK 0x00000010 /* QSPI RX FIFO Not Empty */ > +#define ZYNQMP_QSPI_IXR_GFEMTY_MASK 0x00000080 /* QSPI Generic FIFO Empty */ > +#define ZYNQMP_QSPI_IXR_ALL_MASK (ZYNQMP_QSPI_IXR_TXNFULL_MASK | \ > + ZYNQMP_QSPI_IXR_RXNEMTY_MASK) > + > +/* > + * QSPI Enable Register bit Masks > + * > + * This register is used to enable or disable the QSPI controller > + */ > +#define ZYNQMP_QSPI_ENABLE_ENABLE_MASK 0x00000001 /* QSPI Enable Bit Mask */ > + > +#define ZYNQMP_QSPI_GFIFO_LOW_BUS BIT(14) > +#define ZYNQMP_QSPI_GFIFO_CS_LOWER BIT(12) > +#define ZYNQMP_QSPI_GFIFO_UP_BUS BIT(15) > +#define ZYNQMP_QSPI_GFIFO_CS_UPPER BIT(13) > +#define ZYNQMP_QSPI_SPI_MODE_QSPI (3 << 10) > +#define ZYNQMP_QSPI_SPI_MODE_SPI BIT(10) > +#define ZYNQMP_QSPI_SPI_MODE_DUAL_SPI (2 << 10) > +#define ZYNQMP_QSPI_IMD_DATA_CS_ASSERT 5 > +#define ZYNQMP_QSPI_IMD_DATA_CS_DEASSERT 5 > +#define ZYNQMP_QSPI_GFIFO_TX BIT(16) > +#define ZYNQMP_QSPI_GFIFO_RX BIT(17) > +#define ZYNQMP_QSPI_GFIFO_STRIPE_MASK BIT(18) > +#define ZYNQMP_QSPI_GFIFO_IMD_MASK 0xFF > +#define ZYNQMP_QSPI_GFIFO_EXP_MASK BIT(9) > +#define ZYNQMP_QSPI_GFIFO_DATA_XFR_MASK BIT(8) > +#define ZYNQMP_QSPI_STRT_GEN_FIFO BIT(28) > +#define ZYNQMP_QSPI_GEN_FIFO_STRT_MOD BIT(29) > +#define ZYNQMP_QSPI_GFIFO_WP_HOLD BIT(19) > +#define ZYNQMP_QSPI_BAUD_DIV_MASK (7 << 3) > +#define ZYNQMP_QSPI_DFLT_BAUD_RATE_DIV BIT(3) > +#define ZYNQMP_QSPI_GFIFO_ALL_INT_MASK 0xFBE > +#define ZYNQMP_QSPI_DMA_DST_I_STS_DONE BIT(1) > +#define ZYNQMP_QSPI_DMA_DST_I_STS_MASK 0xFE > +#define MODEBITS 0x6 > + > +#define QUAD_OUT_READ_CMD 0x6B > +#define QUAD_PAGE_PROGRAM_CMD 0x32 > +#define DUAL_OUTPUT_FASTRD_CMD 0x3B > + > +#define ZYNQMP_QSPI_GFIFO_SELECT BIT(0) > + > +#define ZYNQMP_QSPI_FIFO_THRESHOLD 1 > + > +#define SPI_XFER_ON_BOTH 0 > +#define SPI_XFER_ON_LOWER 1 > +#define SPI_XFER_ON_UPPER 2 > + > +#define ZYNQMP_QSPI_DMA_ALIGN 0x4 > +#define ZYNQMP_QSPI_MAX_BAUD_RATE_VAL 7 > +#define ZYNQMP_QSPI_DFLT_BAUD_RATE_VAL 2 > + > +#define ZYNQMP_QSPI_TIMEOUT 100000000 > + > +#define GQSPI_BAUD_DIV_SHIFT 2 > +#define GQSPI_LPBK_DLY_ADJ_LPBK_SHIFT 5 > +#define GQSPI_LPBK_DLY_ADJ_DLY_1 0x2 > +#define GQSPI_LPBK_DLY_ADJ_DLY_1_SHIFT 3 > +#define GQSPI_LPBK_DLY_ADJ_DLY_0 0x3 > +#define GQSPI_USE_DATA_DLY 0x1 > +#define GQSPI_USE_DATA_DLY_SHIFT 31 > +#define GQSPI_DATA_DLY_ADJ_VALUE 0x2 > +#define GQSPI_DATA_DLY_ADJ_SHIFT 28 > +#define TAP_DLY_BYPASS_LQSPI_RX_VALUE 0x1 > +#define TAP_DLY_BYPASS_LQSPI_RX_SHIFT 2 > +#define GQSPI_DATA_DLY_ADJ_OFST 0x000001F8 > +#define IOU_TAPDLY_BYPASS_OFST 0xFF180390 > +#define GQSPI_LPBK_DLY_ADJ_USE_LPBK_MASK 0x00000020 > +#define GQSPI_FREQ_40MHZ 40000000 > +#define GQSPI_FREQ_100MHZ 100000000 > +#define GQSPI_FREQ_150MHZ 150000000 > +#define IOU_TAPDLY_BYPASS_MASK 0x7 > + > +#define ZYNQMP_GQSPI_REG_OFFSET 0x100 > +#define ZYNQMP_GQSPI_DMA_REG_OFFSET 0x800 > + > +/* QSPI register offsets */ > +struct zynqmp_qspi_regs { > + u32 confr; /* 0x00 */ > + u32 isr; /* 0x04 */ > + u32 ier; /* 0x08 */ > + u32 idisr; /* 0x0C */ > + u32 imaskr; /* 0x10 */ > + u32 enbr; /* 0x14 */ > + u32 dr; /* 0x18 */ > + u32 txd0r; /* 0x1C */ > + u32 drxr; /* 0x20 */ > + u32 sicr; /* 0x24 */ > + u32 txftr; /* 0x28 */ > + u32 rxftr; /* 0x2C */ > + u32 gpior; /* 0x30 */ > + u32 reserved0; /* 0x34 */ > + u32 lpbkdly; /* 0x38 */ > + u32 reserved1; /* 0x3C */ > + u32 genfifo; /* 0x40 */ > + u32 gqspisel; /* 0x44 */ > + u32 reserved2; /* 0x48 */ > + u32 gqfifoctrl; /* 0x4C */ > + u32 gqfthr; /* 0x50 */ > + u32 gqpollcfg; /* 0x54 */ > + u32 gqpollto; /* 0x58 */ > + u32 gqxfersts; /* 0x5C */ > + u32 gqfifosnap; /* 0x60 */ > + u32 gqrxcpy; /* 0x64 */ > + u32 reserved3[36]; /* 0x68 */ > + u32 gqspidlyadj; /* 0xF8 */ > +}; > + > +struct zynqmp_qspi_dma_regs { > + u32 dmadst; /* 0x00 */ > + u32 dmasize; /* 0x04 */ > + u32 dmasts; /* 0x08 */ > + u32 dmactrl; /* 0x0C */ > + u32 reserved0; /* 0x10 */ > + u32 dmaisr; /* 0x14 */ > + u32 dmaier; /* 0x18 */ > + u32 dmaidr; /* 0x1C */ > + u32 dmaimr; /* 0x20 */ > + u32 dmactrl2; /* 0x24 */ > + u32 dmadstmsb; /* 0x28 */ > +}; > + > +#endif /* _ASM_ARCH_ZYNQMP_QSPI_H_ */ Move all these on driver file itself, also try to use short macro names. > diff --git a/drivers/spi/Makefile b/drivers/spi/Makefile > index e3184db..9cdd94a 100644 > --- a/drivers/spi/Makefile > +++ b/drivers/spi/Makefile > @@ -50,3 +50,4 @@ obj-$(CONFIG_TI_QSPI) += ti_qspi.o > obj-$(CONFIG_XILINX_SPI) += xilinx_spi.o > obj-$(CONFIG_ZYNQ_SPI) += zynq_spi.o > obj-$(CONFIG_ZYNQ_QSPI) += zynq_qspi.o > +obj-$(CONFIG_ZYNQMP_QSPI) += zynqmp_qspi.o > diff --git a/drivers/spi/zynqmp_qspi.c b/drivers/spi/zynqmp_qspi.c > new file mode 100644 > index 0000000..199e704 > --- /dev/null > +++ b/drivers/spi/zynqmp_qspi.c > @@ -0,0 +1,678 @@ > +/* > + * (C) Copyright 2014 - 2015 Xilinx > + * > + * Xilinx ZynqMP Quad-SPI(QSPI) controller driver (master mode only) > + * > + * SPDX-License-Identifier: GPL-2.0 > + */ > + > +#include <common.h> > +#include <malloc.h> > +#include <memalign.h> > +#include <ubi_uboot.h> > +#include <spi.h> > +#include <spi_flash.h> > +#include <asm/io.h> > +#include <asm/arch/hardware.h> > +#include <asm/arch/sys_proto.h> > +#include <asm/arch/clk.h> > +#include "../mtd/spi/sf_internal.h" This I've already commented and still there any reason? > +#include <clk.h> > +#include <asm/arch/zynqmp_qspi.h> > + > +DECLARE_GLOBAL_DATA_PTR; > + > +struct zynqmp_qspi_platdata { > + struct zynqmp_qspi_regs *regs; > + struct zynqmp_qspi_dma_regs *dma_regs; > + u32 frequency; > + u32 speed_hz; > + unsigned int tx_rx_mode; > +}; > + > +struct zynqmp_qspi_priv { > + struct zynqmp_qspi_regs *regs; > + struct zynqmp_qspi_dma_regs *dma_regs; > + u8 mode; > + const void *tx_buf; > + void *rx_buf; > + unsigned int len; > + int bytes_to_transfer; > + int bytes_to_receive; > + unsigned int is_inst; > + unsigned int cs_change:1; > +}; > + > +static u8 last_cmd; > + > +static int zynqmp_qspi_ofdata_to_platdata(struct udevice *bus) > +{ > + struct zynqmp_qspi_platdata *plat = bus->platdata; > + u32 mode = 0; > + u32 value; > + int ret; > + struct clk clk; > + unsigned long clock; > + > + debug("%s\n", __func__); no need > + > + plat->regs = (struct zynqmp_qspi_regs *)(devfdt_get_addr(bus) + > + ZYNQMP_GQSPI_REG_OFFSET); > + plat->dma_regs = (struct zynqmp_qspi_dma_regs *) > + (devfdt_get_addr(bus) + ZYNQMP_GQSPI_DMA_REG_OFFSET); > + > + ret = clk_get_by_index(bus, 0, &clk); > + if (ret < 0) { > + dev_err(dev, "failed to get clock\n"); > + return ret; > + } > + > + clock = clk_get_rate(&clk); > + if (IS_ERR_VALUE(clock)) { > + dev_err(dev, "failed to get rate\n"); > + return clock; > + } > + debug("%s: CLK %ld\n", __func__, clock); > + > + ret = clk_enable(&clk); > + if (ret && ret != -ENOSYS) { > + dev_err(dev, "failed to enable clock\n"); > + return ret; > + } > + > + value = dev_read_u32_default(bus, "spi-rx-bus-width", 1); > + switch (value) { > + case 1: > + break; > + case 2: > + mode |= SPI_RX_DUAL; > + break; > + case 4: > + mode |= SPI_RX_QUAD; > + break; > + default: > + printf("Invalid spi-rx-bus-width %d\n", value); > + break; > + } > + > + value = dev_read_u32_default(bus, "spi-tx-bus-width", 1); > + switch (value) { > + case 1: > + break; > + case 2: > + mode |= SPI_TX_DUAL; > + break; > + case 4: > + mode |= SPI_TX_QUAD; > + break; > + default: > + printf("Invalid spi-tx-bus-width %d\n", value); > + break; > + } > + > + plat->tx_rx_mode = mode; > + > + plat->frequency = clock; > + plat->speed_hz = plat->frequency; why we need this? all these are generic stuff which is available at spi-uclass.c > + > + return 0; > +} > + > +static void zynqmp_qspi_init_hw(struct zynqmp_qspi_priv *priv) > +{ > + u32 config_reg; > + struct zynqmp_qspi_regs *regs = priv->regs; > + > + writel(ZYNQMP_QSPI_GFIFO_SELECT, ®s->gqspisel); > + writel(ZYNQMP_QSPI_GFIFO_ALL_INT_MASK, ®s->idisr); > + writel(ZYNQMP_QSPI_FIFO_THRESHOLD, ®s->txftr); > + writel(ZYNQMP_QSPI_FIFO_THRESHOLD, ®s->rxftr); > + writel(ZYNQMP_QSPI_GFIFO_ALL_INT_MASK, ®s->isr); > + > + config_reg = readl(®s->confr); > + config_reg &= ~(ZYNQMP_QSPI_GFIFO_STRT_MODE_MASK | > + ZYNQMP_QSPI_CONFIG_MODE_EN_MASK); > + config_reg |= ZYNQMP_QSPI_CONFIG_DMA_MODE | > + ZYNQMP_QSPI_GFIFO_WP_HOLD | > + ZYNQMP_QSPI_DFLT_BAUD_RATE_DIV; > + writel(config_reg, ®s->confr); > + > + writel(ZYNQMP_QSPI_ENABLE_ENABLE_MASK, ®s->enbr); > +} > + > +static u32 zynqmp_qspi_bus_select(struct zynqmp_qspi_priv *priv) > +{ > + u32 gqspi_fifo_reg = 0; > + > + gqspi_fifo_reg = ZYNQMP_QSPI_GFIFO_LOW_BUS | > + ZYNQMP_QSPI_GFIFO_CS_LOWER; > + > + return gqspi_fifo_reg; > +} > + > +static void zynqmp_qspi_fill_gen_fifo(struct zynqmp_qspi_priv *priv, > + u32 gqspi_fifo_reg) > +{ > + struct zynqmp_qspi_regs *regs = priv->regs; > + u32 reg; > + > + do { > + reg = readl(®s->isr); > + } while (!(reg & ZYNQMP_QSPI_IXR_GFEMTY_MASK)); infinite loop? use wait_for_bit with definete duration. > + > + writel(gqspi_fifo_reg, ®s->genfifo); > +} > + > +static void zynqmp_qspi_chipselect(struct zynqmp_qspi_priv *priv, int is_on) > +{ > + u32 gqspi_fifo_reg = 0; > + > + if (is_on) { > + gqspi_fifo_reg = zynqmp_qspi_bus_select(priv); > + gqspi_fifo_reg |= ZYNQMP_QSPI_SPI_MODE_SPI | > + ZYNQMP_QSPI_IMD_DATA_CS_ASSERT; > + } else { > + gqspi_fifo_reg = ZYNQMP_QSPI_GFIFO_LOW_BUS; > + gqspi_fifo_reg |= ZYNQMP_QSPI_IMD_DATA_CS_DEASSERT; > + } > + > + debug("GFIFO_CMD_CS: 0x%x\n", gqspi_fifo_reg); > + > + zynqmp_qspi_fill_gen_fifo(priv, gqspi_fifo_reg); > +} > + > +void zynqmp_qspi_set_tapdelay(struct udevice *bus, u32 baudrateval) > +{ > + struct zynqmp_qspi_platdata *plat = bus->platdata; > + struct zynqmp_qspi_priv *priv = dev_get_priv(bus); > + struct zynqmp_qspi_regs *regs = priv->regs; > + u32 tapdlybypass = 0, lpbkdlyadj = 0, datadlyadj = 0, clk_rate; > + u32 reqhz = 0; > + > + clk_rate = plat->frequency; > + reqhz = (clk_rate / (GQSPI_BAUD_DIV_SHIFT << baudrateval)); > + > + debug("%s, req_hz:%d, clk_rate:%d, baudrateval:%d\n", > + __func__, reqhz, clk_rate, baudrateval); > + > + if (reqhz < GQSPI_FREQ_40MHZ) { > + zynqmp_mmio_read(IOU_TAPDLY_BYPASS_OFST, &tapdlybypass); > + tapdlybypass |= (TAP_DLY_BYPASS_LQSPI_RX_VALUE << > + TAP_DLY_BYPASS_LQSPI_RX_SHIFT); > + } else if (reqhz < GQSPI_FREQ_100MHZ) { > + zynqmp_mmio_read(IOU_TAPDLY_BYPASS_OFST, &tapdlybypass); > + tapdlybypass |= (TAP_DLY_BYPASS_LQSPI_RX_VALUE << > + TAP_DLY_BYPASS_LQSPI_RX_SHIFT); > + lpbkdlyadj = readl(®s->lpbkdly); > + lpbkdlyadj |= (GQSPI_LPBK_DLY_ADJ_USE_LPBK_MASK); > + datadlyadj = readl(®s->gqspidlyadj); > + datadlyadj |= ((GQSPI_USE_DATA_DLY << GQSPI_USE_DATA_DLY_SHIFT) > + | (GQSPI_DATA_DLY_ADJ_VALUE << > + GQSPI_DATA_DLY_ADJ_SHIFT)); > + } else if (reqhz < GQSPI_FREQ_150MHZ) { > + lpbkdlyadj = readl(®s->lpbkdly); > + lpbkdlyadj |= ((GQSPI_LPBK_DLY_ADJ_USE_LPBK_MASK) | > + GQSPI_LPBK_DLY_ADJ_DLY_0); > + } > + > + zynqmp_mmio_write(IOU_TAPDLY_BYPASS_OFST, IOU_TAPDLY_BYPASS_MASK, > + tapdlybypass); > + writel(lpbkdlyadj, ®s->lpbkdly); > + writel(datadlyadj, ®s->gqspidlyadj); > +} > + > +static int zynqmp_qspi_set_speed(struct udevice *bus, uint speed) > +{ > + struct zynqmp_qspi_platdata *plat = bus->platdata; > + struct zynqmp_qspi_priv *priv = dev_get_priv(bus); > + struct zynqmp_qspi_regs *regs = priv->regs; > + u32 confr; > + u8 baud_rate_val = 0; > + > + debug("%s\n", __func__); no need > + if (speed > plat->frequency) > + speed = plat->frequency; > + > + /* Set the clock frequency */ > + confr = readl(®s->confr); > + if (speed == 0) { > + /* Set baudrate x8, if the freq is 0 */ > + baud_rate_val = ZYNQMP_QSPI_DFLT_BAUD_RATE_VAL; > + } else if (plat->speed_hz != speed) { > + while ((baud_rate_val < 8) && > + ((plat->frequency / > + (2 << baud_rate_val)) > speed)) > + baud_rate_val++; > + > + if (baud_rate_val > ZYNQMP_QSPI_MAX_BAUD_RATE_VAL) > + baud_rate_val = ZYNQMP_QSPI_DFLT_BAUD_RATE_VAL; > + > + plat->speed_hz = plat->frequency / (2 << baud_rate_val); > + } > + confr &= ~ZYNQMP_QSPI_BAUD_DIV_MASK; > + confr |= (baud_rate_val << 3); > + writel(confr, ®s->confr); > + > + zynqmp_qspi_set_tapdelay(bus, baud_rate_val); > + debug("regs=%p, speed=%d\n", priv->regs, plat->speed_hz); > + > + return 0; > +} > + > +static int zynqmp_qspi_child_pre_probe(struct udevice *bus) > +{ > + struct spi_slave *slave = dev_get_parent_priv(bus); > + struct zynqmp_qspi_platdata *plat = dev_get_platdata(bus->parent); > + > + slave->mode = plat->tx_rx_mode; > + > + return 0; > +} mode we can get it from spi-uclass, no need to have this. > + > +static int zynqmp_qspi_probe(struct udevice *bus) > +{ > + struct zynqmp_qspi_platdata *plat = dev_get_platdata(bus); > + struct zynqmp_qspi_priv *priv = dev_get_priv(bus); > + > + debug("%s: bus:%p, priv:%p\n", __func__, bus, priv); no need > + > + priv->regs = plat->regs; > + priv->dma_regs = plat->dma_regs; > + > + /* init the zynq spi hw */ > + zynqmp_qspi_init_hw(priv); > + > + return 0; > +} > + > +static int zynqmp_qspi_set_mode(struct udevice *bus, uint mode) > +{ > + struct zynqmp_qspi_priv *priv = dev_get_priv(bus); > + struct zynqmp_qspi_regs *regs = priv->regs; > + u32 confr; > + > + debug("%s\n", __func__); > + /* Set the SPI Clock phase and polarities */ > + confr = readl(®s->confr); > + confr &= ~(ZYNQMP_QSPI_CONFIG_CPHA_MASK | > + ZYNQMP_QSPI_CONFIG_CPOL_MASK); > + > + if (priv->mode & SPI_CPHA) > + confr |= ZYNQMP_QSPI_CONFIG_CPHA_MASK; > + if (priv->mode & SPI_CPOL) > + confr |= ZYNQMP_QSPI_CONFIG_CPOL_MASK; > + missing confr write? > + priv->mode = mode; > + > + debug("regs=%p, mode=%d\n", priv->regs, priv->mode); no need > + > + return 0; > +} > + > +static int zynqmp_qspi_fill_tx_fifo(struct zynqmp_qspi_priv *priv, u32 size) > +{ > + u32 data; > + u32 timeout = ZYNQMP_QSPI_TIMEOUT; > + struct zynqmp_qspi_regs *regs = priv->regs; > + u32 *buf = (u32 *)priv->tx_buf; > + u32 len = size; > + > + debug("TxFIFO: 0x%x, size: 0x%x\n", readl(®s->isr), > + size); > + > + while (size && timeout) { > + if (readl(®s->isr) & > + ZYNQMP_QSPI_IXR_TXNFULL_MASK) { > + if (size >= 4) { > + writel(*buf, ®s->txd0r); > + buf++; > + size -= 4; > + } else { > + switch (size) { > + case 1: > + data = *((u8 *)buf); > + buf += 1; > + data |= 0xFFFFFF00; > + break; > + case 2: > + data = *((u16 *)buf); > + buf += 2; > + data |= 0xFFFF0000; > + break; > + case 3: > + data = *((u16 *)buf); > + buf += 2; > + data |= (*((u8 *)buf) << 16); > + buf += 1; > + data |= 0xFF000000; > + break; > + } > + writel(data, ®s->txd0r); > + size = 0; > + } > + } else { > + udelay(1); > + timeout--; > + } > + } > + if (!timeout) { > + printf("%s: Timeout\n", __func__); > + return -1; > + } > + > + priv->tx_buf += len; > + return 0; > +} > + > +static void zynqmp_qspi_genfifo_cmd(struct zynqmp_qspi_priv *priv) > +{ > + u8 command = 1; > + u32 gen_fifo_cmd; > + u32 bytecount = 0; > + > + while (priv->len) { > + gen_fifo_cmd = zynqmp_qspi_bus_select(priv); > + gen_fifo_cmd |= ZYNQMP_QSPI_GFIFO_TX; > + > + if (command) { > + command = 0; > + last_cmd = *(u8 *)priv->tx_buf; > + } > + > + gen_fifo_cmd |= ZYNQMP_QSPI_SPI_MODE_SPI; > + gen_fifo_cmd |= *(u8 *)priv->tx_buf; > + bytecount++; > + priv->len--; > + priv->tx_buf = (u8 *)priv->tx_buf + 1; > + > + debug("GFIFO_CMD_Cmd = 0x%x\n", gen_fifo_cmd); > + > + zynqmp_qspi_fill_gen_fifo(priv, gen_fifo_cmd); > + } > +} > + > +static u32 zynqmp_qspi_calc_exp(struct zynqmp_qspi_priv *priv, > + u32 *gen_fifo_cmd) > +{ > + u32 expval = 8; > + u32 len; > + > + while (1) { > + if (priv->len > 255) { > + if (priv->len & (1 << expval)) { > + *gen_fifo_cmd &= ~ZYNQMP_QSPI_GFIFO_IMD_MASK; > + *gen_fifo_cmd |= ZYNQMP_QSPI_GFIFO_EXP_MASK; > + *gen_fifo_cmd |= expval; > + priv->len -= (1 << expval); > + return expval; > + } > + expval++; > + } else { > + *gen_fifo_cmd &= ~(ZYNQMP_QSPI_GFIFO_IMD_MASK | > + ZYNQMP_QSPI_GFIFO_EXP_MASK); > + *gen_fifo_cmd |= (u8)priv->len; > + len = (u8)priv->len; > + priv->len = 0; > + return len; > + } > + } > +} > + > +static int zynqmp_qspi_genfifo_fill_tx(struct zynqmp_qspi_priv *priv) > +{ > + u32 gen_fifo_cmd; > + u32 len; > + int ret = 0; > + > + gen_fifo_cmd = zynqmp_qspi_bus_select(priv); > + gen_fifo_cmd |= ZYNQMP_QSPI_GFIFO_TX | > + ZYNQMP_QSPI_GFIFO_DATA_XFR_MASK; > + > + if (last_cmd == QUAD_PAGE_PROGRAM_CMD) > + gen_fifo_cmd |= ZYNQMP_QSPI_SPI_MODE_QSPI; > + else > + gen_fifo_cmd |= ZYNQMP_QSPI_SPI_MODE_SPI; > + > + while (priv->len) { > + len = zynqmp_qspi_calc_exp(priv, &gen_fifo_cmd); > + zynqmp_qspi_fill_gen_fifo(priv, gen_fifo_cmd); > + > + debug("GFIFO_CMD_TX:0x%x\n", gen_fifo_cmd); > + > + if (gen_fifo_cmd & ZYNQMP_QSPI_GFIFO_EXP_MASK) > + ret = zynqmp_qspi_fill_tx_fifo(priv, > + 1 << len); > + else > + ret = zynqmp_qspi_fill_tx_fifo(priv, > + len); > + > + if (ret) > + return ret; > + } > + return ret; > +} > + > +static int zynqmp_qspi_start_dma(struct zynqmp_qspi_priv *priv, > + u32 gen_fifo_cmd, u32 *buf) > +{ > + u32 addr; > + u32 size, len; > + u32 timeout = ZYNQMP_QSPI_TIMEOUT; > + u32 actuallen = priv->len; > + struct zynqmp_qspi_dma_regs *dma_regs = priv->dma_regs; > + > + writel((unsigned long)buf, &dma_regs->dmadst); > + writel(roundup(priv->len, 4), &dma_regs->dmasize); > + writel(ZYNQMP_QSPI_DMA_DST_I_STS_MASK, &dma_regs->dmaier); > + addr = (unsigned long)buf; > + size = roundup(priv->len, ARCH_DMA_MINALIGN); > + flush_dcache_range(addr, addr + size); > + > + while (priv->len) { > + len = zynqmp_qspi_calc_exp(priv, &gen_fifo_cmd); > + if (!(gen_fifo_cmd & ZYNQMP_QSPI_GFIFO_EXP_MASK) && > + (len % 4)) { > + gen_fifo_cmd &= ~(0xFF); > + gen_fifo_cmd |= (len / 4 + 1) * 4; > + } > + zynqmp_qspi_fill_gen_fifo(priv, gen_fifo_cmd); > + > + debug("GFIFO_CMD_RX:0x%x\n", gen_fifo_cmd); > + } > + > + while (timeout) { > + if (readl(&dma_regs->dmaisr) & > + ZYNQMP_QSPI_DMA_DST_I_STS_DONE) { > + writel(ZYNQMP_QSPI_DMA_DST_I_STS_DONE, > + &dma_regs->dmaisr); > + break; > + } > + udelay(1); > + timeout--; > + } wait_for_bit? > + > + debug("buf:0x%lx, rxbuf:0x%lx, *buf:0x%x len: 0x%x\n", > + (unsigned long)buf, (unsigned long)priv->rx_buf, *buf, > + actuallen); > + if (!timeout) { > + printf("DMA Timeout:0x%x\n", readl(&dma_regs->dmaisr)); > + return -1; > + } > + > + if (buf != priv->rx_buf) > + memcpy(priv->rx_buf, buf, actuallen); > + > + return 0; > +} > + > +static int zynqmp_qspi_genfifo_fill_rx(struct zynqmp_qspi_priv *priv) > +{ > + u32 gen_fifo_cmd; > + u32 *buf; > + u32 actuallen = priv->len; > + > + gen_fifo_cmd = zynqmp_qspi_bus_select(priv); > + gen_fifo_cmd |= ZYNQMP_QSPI_GFIFO_RX | > + ZYNQMP_QSPI_GFIFO_DATA_XFR_MASK; > + > + if (last_cmd == QUAD_OUT_READ_CMD) > + gen_fifo_cmd |= ZYNQMP_QSPI_SPI_MODE_QSPI; > + else if (last_cmd == DUAL_OUTPUT_FASTRD_CMD) > + gen_fifo_cmd |= ZYNQMP_QSPI_SPI_MODE_DUAL_SPI; > + else > + gen_fifo_cmd |= ZYNQMP_QSPI_SPI_MODE_SPI; > + > + /* > + * Check if receive buffer is aligned to 4 byte and length > + * is multiples of four byte as we are using dma to receive. > + */ > + if (!((unsigned long)priv->rx_buf & (ZYNQMP_QSPI_DMA_ALIGN - 1)) && > + !(actuallen % ZYNQMP_QSPI_DMA_ALIGN)) { > + buf = (u32 *)priv->rx_buf; > + return zynqmp_qspi_start_dma(priv, gen_fifo_cmd, buf); > + } > + > + ALLOC_CACHE_ALIGN_BUFFER(u8, tmp, roundup(priv->len, > + ZYNQMP_QSPI_DMA_ALIGN)); > + buf = (u32 *)tmp; > + return zynqmp_qspi_start_dma(priv, gen_fifo_cmd, buf); > +} > + > +static int zynqmp_qspi_start_transfer(struct zynqmp_qspi_priv *priv) > +{ > + int ret = 0; > + > + if (priv->is_inst) { > + if (priv->tx_buf) > + zynqmp_qspi_genfifo_cmd(priv); > + else > + ret = -1; > + } else { > + if (priv->tx_buf) > + ret = zynqmp_qspi_genfifo_fill_tx(priv); > + else if (priv->rx_buf) > + ret = zynqmp_qspi_genfifo_fill_rx(priv); > + else > + ret = -1; > + } > + return ret; > +} > + > +static int zynqmp_qspi_transfer(struct zynqmp_qspi_priv *priv) > +{ > + static unsigned int cs_change = 1; > + int status = 0; > + > + debug("%s\n", __func__); > + > + while (1) { > + /* Select the chip if required */ > + if (cs_change) > + zynqmp_qspi_chipselect(priv, 1); > + > + cs_change = priv->cs_change; > + > + if (!priv->tx_buf && !priv->rx_buf && priv->len) { > + status = -1; > + break; > + } > + > + /* Request the transfer */ > + if (priv->len) { > + status = zynqmp_qspi_start_transfer(priv); > + priv->is_inst = 0; > + if (status < 0) > + break; > + } > + > + if (cs_change) > + /* Deselect the chip */ > + zynqmp_qspi_chipselect(priv, 0); > + break; > + } > + > + return status; > +} > + > +static int zynqmp_qspi_claim_bus(struct udevice *dev) > +{ > + struct udevice *bus = dev->parent; > + struct zynqmp_qspi_priv *priv = dev_get_priv(bus); > + struct zynqmp_qspi_regs *regs = priv->regs; > + > + debug("%s\n", __func__); no need > + writel(ZYNQMP_QSPI_ENABLE_ENABLE_MASK, ®s->enbr); > + > + return 0; > +} > + > +static int zynqmp_qspi_release_bus(struct udevice *dev) > +{ > + struct udevice *bus = dev->parent; > + struct zynqmp_qspi_priv *priv = dev_get_priv(bus); > + struct zynqmp_qspi_regs *regs = priv->regs; > + > + debug("%s\n", __func__); no need
Hi Siva, Sorry for the very late reply! > -----Original Message----- > From: Siva Durga Prasad Paladugu [mailto:siva.durga.paladugu@xilinx.com] > Sent: Thursday, January 04, 2018 1:08 PM > To: u-boot@lists.denx.de > Cc: jagannadh.teki@gmail.com; Siva Durga Prasad Paladugu > <sivadur@xilinx.com> > Subject: [PATCH v2 1/2] spi: zynqmp_qspi: Add support for ZynqMP qspi > driver > > This patch adds qspi driver support for ZynqMP SoC. This driver is > responsible for communicating with qspi flash devices. The Technical Reference Manual of the ZynqMP talks about the LQSPI and the GQSPI. Based on the #defines, I'm guessing this is for the GQSPI but should we be more explicit about it? > > Signed-off-by: Siva Durga Prasad Paladugu <sivadur@xilinx.com> > --- > Changes from v1: > - Rebased on top of latest master > - Moved macro definitions to .h file as per comment > - Fixed magic values with macros as per comment > --- > arch/arm/cpu/armv8/zynqmp/Kconfig | 7 + > arch/arm/include/asm/arch-zynqmp/zynqmp_qspi.h | 154 ++++++ > drivers/spi/Makefile | 1 + > drivers/spi/zynqmp_qspi.c | 678 > +++++++++++++++++++++++++ > 4 files changed, 840 insertions(+) > create mode 100644 arch/arm/include/asm/arch-zynqmp/zynqmp_qspi.h > create mode 100644 drivers/spi/zynqmp_qspi.c I tried building on top of master and running it on a zcu102 (Rev-B) board but I can't get anything newer than v2017.11 to work. I get this failure (unrelated to this series): In: serial@ff000000 Out: serial@ff000000 Err: serial@ff000000 initcall sequence 000000007ff8dee8 failed at call 0000000008002c7c (err=-22) ### ERROR ### Please RESET the board ### After looking arround a little, it seems it may be because of my FSBL. Since I can't get another FSBL for now, I rebased the series on top of v2017.11 and it seems to be working well except for the erase operation in a certain range of flash addresses. The same operations (in that range) in Linux seem to be working. I'm guessing this is due to something else, maybe in the spi_flash driver. Here is the test I used: ZynqMP> sf probe SF: Detected n25q512a with page size 256 Bytes, erase size 4 KiB, total 64 MiB ZynqMP> mw.w 0x100 0x00 0x100 ZynqMP> md.w 0x100 00000100: 0000 0000 0000 0000 0000 0000 0000 0000 ................ 00000110: 0000 0000 0000 0000 0000 0000 0000 0000 ................ 00000120: 0000 0000 0000 0000 0000 0000 0000 0000 ................ 00000130: 0000 0000 0000 0000 0000 0000 0000 0000 ................ 00000140: 0000 0000 0000 0000 0000 0000 0000 0000 ................ 00000150: 0000 0000 0000 0000 0000 0000 0000 0000 ................ 00000160: 0000 0000 0000 0000 0000 0000 0000 0000 ................ 00000170: 0000 0000 0000 0000 0000 0000 0000 0000 ................ ZynqMP> sf read 0x100 0x00 0x100 device 0 offset 0x0, size 0x100 SF: 256 bytes @ 0x0 Read: OK ZynqMP> md.w 0x100 00000100: 1234 1234 abcd abcd abcd abcd abcd abcd 4.4............. 00000110: abcd abcd abcd abcd abcd abcd abcd abcd ................ 00000120: ffff ffff ffff ffff ffff ffff ffff ffff ................ 00000130: ffff ffff ffff ffff ffff ffff ffff ffff ................ 00000140: ffff ffff ffff ffff ffff ffff ffff ffff ................ 00000150: ffff ffff ffff ffff ffff ffff ffff ffff ................ 00000160: ffff ffff ffff ffff ffff ffff ffff ffff ................ 00000170: ffff ffff ffff ffff ffff ffff ffff ffff ................ ZynqMP> mw.w 0x100 0xbeee 0x10 ZynqMP> md.w 0x100 00000100: beee beee beee beee beee beee beee beee ................ 00000110: beee beee beee beee beee beee beee beee ................ 00000120: ffff ffff ffff ffff ffff ffff ffff ffff ................ 00000130: ffff ffff ffff ffff ffff ffff ffff ffff ................ 00000140: ffff ffff ffff ffff ffff ffff ffff ffff ................ 00000150: ffff ffff ffff ffff ffff ffff ffff ffff ................ 00000160: ffff ffff ffff ffff ffff ffff ffff ffff ................ 00000170: ffff ffff ffff ffff ffff ffff ffff ffff ................ ZynqMP> sf update 0x100 0x00 0x100 device 0 offset 0x0, size 0x100 256 bytes written, 0 bytes skipped in 0.70s, speed 3591 B/s ZynqMP> mw.w 0x100 0x00 0x100 ZynqMP> md.w 0x100 00000100: 0000 0000 0000 0000 0000 0000 0000 0000 ................ 00000110: 0000 0000 0000 0000 0000 0000 0000 0000 ................ 00000120: 0000 0000 0000 0000 0000 0000 0000 0000 ................ 00000130: 0000 0000 0000 0000 0000 0000 0000 0000 ................ 00000140: 0000 0000 0000 0000 0000 0000 0000 0000 ................ 00000150: 0000 0000 0000 0000 0000 0000 0000 0000 ................ 00000160: 0000 0000 0000 0000 0000 0000 0000 0000 ................ 00000170: 0000 0000 0000 0000 0000 0000 0000 0000 ................ ZynqMP> sf read 0x100 0x00 0x100 device 0 offset 0x0, size 0x100 SF: 256 bytes @ 0x0 Read: OK ZynqMP> md.w 0x100 00000100: beee beee beee beee beee beee beee beee ................ 00000110: beee beee beee beee beee beee beee beee ................ 00000120: ffff ffff ffff ffff ffff ffff ffff ffff ................ 00000130: ffff ffff ffff ffff ffff ffff ffff ffff ................ 00000140: ffff ffff ffff ffff ffff ffff ffff ffff ................ 00000150: ffff ffff ffff ffff ffff ffff ffff ffff ................ 00000160: ffff ffff ffff ffff ffff ffff ffff ffff ................ 00000170: ffff ffff ffff ffff ffff ffff ffff ffff ................ Here is a case where it failed: ZynqMP> mw.w 100 abcd 10 ; md.w 100 10 00000100: abcd abcd abcd abcd abcd abcd abcd abcd ................ 00000110: abcd abcd abcd abcd abcd abcd abcd abcd ................ ZynqMP> sf update 100 100 10 device 0 offset 0x100, size 0x10 SPI flash failed in erase step ZynqMP> mw.w 100 00 100 ; sf read 100 100 10 ; md.w 100 10 device 0 offset 0x100, size 0x10 SF: 16 bytes @ 0x100 Read: OK 00000100: ffff ffff ffff ffff ffff ffff ffff ffff ................ 00000110: 0000 0000 0000 0000 0000 0000 0000 0000 ................ I hope this helps! Thanks, Liam Beguin Xiphos Systems Corp. http://xiphos.ca
Hi Jagan, > -----Original Message----- > From: Jagan Teki [mailto:jagan@amarulasolutions.com] > Sent: Tuesday, January 23, 2018 10:41 PM > To: Siva Durga Prasad Paladugu <sivadur@xilinx.com> > Cc: U-Boot-Denx <u-boot@lists.denx.de>; Siva Durga Prasad Paladugu > <sivadur@xilinx.com> > Subject: Re: [U-Boot] [PATCH v2 1/2] spi: zynqmp_qspi: Add support for > ZynqMP qspi driver > > On Thu, Jan 4, 2018 at 1:07 PM, Siva Durga Prasad Paladugu > <siva.durga.paladugu@xilinx.com> wrote: > > This patch adds qspi driver support for ZynqMP SoC. This driver is > > responsible for communicating with qspi flash devices. > > > > Signed-off-by: Siva Durga Prasad Paladugu <sivadur@xilinx.com> > > --- > > Changes from v1: > > - Rebased on top of latest master > > - Moved macro definitions to .h file as per comment > > - Fixed magic values with macros as per comment > > --- > > arch/arm/cpu/armv8/zynqmp/Kconfig | 7 + > > arch/arm/include/asm/arch-zynqmp/zynqmp_qspi.h | 154 ++++++ > > drivers/spi/Makefile | 1 + > > drivers/spi/zynqmp_qspi.c | 678 > +++++++++++++++++++++++++ > > Was this gqspi like linux spi-zynqmp-gqspi.c or different? Yes. > > > 4 files changed, 840 insertions(+) > > create mode 100644 arch/arm/include/asm/arch- > zynqmp/zynqmp_qspi.h > > create mode 100644 drivers/spi/zynqmp_qspi.c > > > > diff --git a/arch/arm/cpu/armv8/zynqmp/Kconfig > > b/arch/arm/cpu/armv8/zynqmp/Kconfig > > index 3f922b4..2fe4f71 100644 > > --- a/arch/arm/cpu/armv8/zynqmp/Kconfig > > +++ b/arch/arm/cpu/armv8/zynqmp/Kconfig > > @@ -65,6 +65,13 @@ config PMUFW_INIT_FILE > > Include external PMUFW (Platform Management Unit FirmWare) to > > a Xilinx bootable image (boot.bin). > > > > +config ZYNQMP_QSPI > > + bool "Configure ZynqMP QSPI" > > + select DM_SPI > > + help > > + This option is used to enable ZynqMP QSPI controller driver which > > + is used to communicate with qspi flash devices. > > I've commented this before, what is the reason for adding spi kconfig entry > in arch area instead of drivers/spi? I might have missed it, Will move to drivers/spi > > > + > > config ZYNQMP_USB > > bool "Configure ZynqMP USB" > > > > diff --git a/arch/arm/include/asm/arch-zynqmp/zynqmp_qspi.h > > b/arch/arm/include/asm/arch-zynqmp/zynqmp_qspi.h > > new file mode 100644 > > index 0000000..5e2926e > > --- /dev/null > > +++ b/arch/arm/include/asm/arch-zynqmp/zynqmp_qspi.h > > @@ -0,0 +1,154 @@ > > +/* > > + * (C) Copyright 2014 - 2015 Xilinx > > + * > > + * Xilinx ZynqMP Quad-SPI(QSPI) controller driver (master mode only) > > + * > > + * SPDX-License-Identifier: GPL-2.0+ > > + */ > > + > > +#ifndef _ASM_ARCH_ZYNQMP_QSPI_H_ > > +#define _ASM_ARCH_ZYNQMP_QSPI_H_ > > + > > +#define ZYNQMP_QSPI_GFIFO_STRT_MODE_MASK BIT(29) > > +#define ZYNQMP_QSPI_CONFIG_MODE_EN_MASK (3 << 30) > > +#define ZYNQMP_QSPI_CONFIG_DMA_MODE (2 << 30) > > +#define ZYNQMP_QSPI_CONFIG_CPHA_MASK BIT(2) > > +#define ZYNQMP_QSPI_CONFIG_CPOL_MASK BIT(1) > > + > > +/* QSPI MIO's count for different connection topologies */ > > +#define ZYNQMP_QSPI_MIO_NUM_QSPI0 6 > > +#define ZYNQMP_QSPI_MIO_NUM_QSPI1 5 > > +#define ZYNQMP_QSPI_MIO_NUM_QSPI1_CS 1 > > + > > +/* > > + * QSPI Interrupt Registers bit Masks > > + * > > + * All the four interrupt registers (Status/Mask/Enable/Disable) have > > +the same > > + * bit definitions. > > + */ > > +#define ZYNQMP_QSPI_IXR_TXNFULL_MASK 0x00000004 /* QSPI TX > FIFO Overflow */ > > +#define ZYNQMP_QSPI_IXR_TXFULL_MASK 0x00000008 /* QSPI TX > FIFO is full */ > > +#define ZYNQMP_QSPI_IXR_RXNEMTY_MASK 0x00000010 /* QSPI RX > FIFO Not Empty */ > > +#define ZYNQMP_QSPI_IXR_GFEMTY_MASK 0x00000080 /* QSPI > Generic FIFO Empty */ > > +#define ZYNQMP_QSPI_IXR_ALL_MASK > (ZYNQMP_QSPI_IXR_TXNFULL_MASK | \ > > + ZYNQMP_QSPI_IXR_RXNEMTY_MASK) > > + > > +/* > > + * QSPI Enable Register bit Masks > > + * > > + * This register is used to enable or disable the QSPI controller */ > > +#define ZYNQMP_QSPI_ENABLE_ENABLE_MASK 0x00000001 /* QSPI > Enable Bit > > +Mask */ > > + > > +#define ZYNQMP_QSPI_GFIFO_LOW_BUS BIT(14) > > +#define ZYNQMP_QSPI_GFIFO_CS_LOWER BIT(12) > > +#define ZYNQMP_QSPI_GFIFO_UP_BUS BIT(15) > > +#define ZYNQMP_QSPI_GFIFO_CS_UPPER BIT(13) > > +#define ZYNQMP_QSPI_SPI_MODE_QSPI (3 << 10) > > +#define ZYNQMP_QSPI_SPI_MODE_SPI BIT(10) > > +#define ZYNQMP_QSPI_SPI_MODE_DUAL_SPI (2 << 10) > > +#define ZYNQMP_QSPI_IMD_DATA_CS_ASSERT 5 > > +#define ZYNQMP_QSPI_IMD_DATA_CS_DEASSERT 5 > > +#define ZYNQMP_QSPI_GFIFO_TX BIT(16) > > +#define ZYNQMP_QSPI_GFIFO_RX BIT(17) > > +#define ZYNQMP_QSPI_GFIFO_STRIPE_MASK BIT(18) > > +#define ZYNQMP_QSPI_GFIFO_IMD_MASK 0xFF > > +#define ZYNQMP_QSPI_GFIFO_EXP_MASK BIT(9) > > +#define ZYNQMP_QSPI_GFIFO_DATA_XFR_MASK BIT(8) > > +#define ZYNQMP_QSPI_STRT_GEN_FIFO BIT(28) > > +#define ZYNQMP_QSPI_GEN_FIFO_STRT_MOD BIT(29) > > +#define ZYNQMP_QSPI_GFIFO_WP_HOLD BIT(19) > > +#define ZYNQMP_QSPI_BAUD_DIV_MASK (7 << 3) > > +#define ZYNQMP_QSPI_DFLT_BAUD_RATE_DIV BIT(3) #define > > +ZYNQMP_QSPI_GFIFO_ALL_INT_MASK 0xFBE #define > > +ZYNQMP_QSPI_DMA_DST_I_STS_DONE BIT(1) #define > > +ZYNQMP_QSPI_DMA_DST_I_STS_MASK 0xFE > > +#define MODEBITS 0x6 > > + > > +#define QUAD_OUT_READ_CMD 0x6B > > +#define QUAD_PAGE_PROGRAM_CMD 0x32 > > +#define DUAL_OUTPUT_FASTRD_CMD 0x3B > > + > > +#define ZYNQMP_QSPI_GFIFO_SELECT BIT(0) > > + > > +#define ZYNQMP_QSPI_FIFO_THRESHOLD 1 > > + > > +#define SPI_XFER_ON_BOTH 0 > > +#define SPI_XFER_ON_LOWER 1 > > +#define SPI_XFER_ON_UPPER 2 > > + > > +#define ZYNQMP_QSPI_DMA_ALIGN 0x4 > > +#define ZYNQMP_QSPI_MAX_BAUD_RATE_VAL 7 #define > > +ZYNQMP_QSPI_DFLT_BAUD_RATE_VAL 2 > > + > > +#define ZYNQMP_QSPI_TIMEOUT 100000000 > > + > > +#define GQSPI_BAUD_DIV_SHIFT 2 > > +#define GQSPI_LPBK_DLY_ADJ_LPBK_SHIFT 5 > > +#define GQSPI_LPBK_DLY_ADJ_DLY_1 0x2 > > +#define GQSPI_LPBK_DLY_ADJ_DLY_1_SHIFT 3 > > +#define GQSPI_LPBK_DLY_ADJ_DLY_0 0x3 > > +#define GQSPI_USE_DATA_DLY 0x1 > > +#define GQSPI_USE_DATA_DLY_SHIFT 31 > > +#define GQSPI_DATA_DLY_ADJ_VALUE 0x2 > > +#define GQSPI_DATA_DLY_ADJ_SHIFT 28 > > +#define TAP_DLY_BYPASS_LQSPI_RX_VALUE 0x1 #define > > +TAP_DLY_BYPASS_LQSPI_RX_SHIFT 2 > > +#define GQSPI_DATA_DLY_ADJ_OFST 0x000001F8 > > +#define IOU_TAPDLY_BYPASS_OFST 0xFF180390 > > +#define GQSPI_LPBK_DLY_ADJ_USE_LPBK_MASK 0x00000020 > > +#define GQSPI_FREQ_40MHZ 40000000 > > +#define GQSPI_FREQ_100MHZ 100000000 > > +#define GQSPI_FREQ_150MHZ 150000000 > > +#define IOU_TAPDLY_BYPASS_MASK 0x7 > > + > > +#define ZYNQMP_GQSPI_REG_OFFSET 0x100 > > +#define ZYNQMP_GQSPI_DMA_REG_OFFSET 0x800 > > + > > +/* QSPI register offsets */ > > +struct zynqmp_qspi_regs { > > + u32 confr; /* 0x00 */ > > + u32 isr; /* 0x04 */ > > + u32 ier; /* 0x08 */ > > + u32 idisr; /* 0x0C */ > > + u32 imaskr; /* 0x10 */ > > + u32 enbr; /* 0x14 */ > > + u32 dr; /* 0x18 */ > > + u32 txd0r; /* 0x1C */ > > + u32 drxr; /* 0x20 */ > > + u32 sicr; /* 0x24 */ > > + u32 txftr; /* 0x28 */ > > + u32 rxftr; /* 0x2C */ > > + u32 gpior; /* 0x30 */ > > + u32 reserved0; /* 0x34 */ > > + u32 lpbkdly; /* 0x38 */ > > + u32 reserved1; /* 0x3C */ > > + u32 genfifo; /* 0x40 */ > > + u32 gqspisel; /* 0x44 */ > > + u32 reserved2; /* 0x48 */ > > + u32 gqfifoctrl; /* 0x4C */ > > + u32 gqfthr; /* 0x50 */ > > + u32 gqpollcfg; /* 0x54 */ > > + u32 gqpollto; /* 0x58 */ > > + u32 gqxfersts; /* 0x5C */ > > + u32 gqfifosnap; /* 0x60 */ > > + u32 gqrxcpy; /* 0x64 */ > > + u32 reserved3[36]; /* 0x68 */ > > + u32 gqspidlyadj; /* 0xF8 */ > > +}; > > + > > +struct zynqmp_qspi_dma_regs { > > + u32 dmadst; /* 0x00 */ > > + u32 dmasize; /* 0x04 */ > > + u32 dmasts; /* 0x08 */ > > + u32 dmactrl; /* 0x0C */ > > + u32 reserved0; /* 0x10 */ > > + u32 dmaisr; /* 0x14 */ > > + u32 dmaier; /* 0x18 */ > > + u32 dmaidr; /* 0x1C */ > > + u32 dmaimr; /* 0x20 */ > > + u32 dmactrl2; /* 0x24 */ > > + u32 dmadstmsb; /* 0x28 */ > > +}; > > + > > +#endif /* _ASM_ARCH_ZYNQMP_QSPI_H_ */ > > Move all these on driver file itself, also try to use short macro names. I moved to .h based on v1 comments, now vice versa. I didn’t see any problem in having these in .h > > > diff --git a/drivers/spi/Makefile b/drivers/spi/Makefile index > > e3184db..9cdd94a 100644 > > --- a/drivers/spi/Makefile > > +++ b/drivers/spi/Makefile > > @@ -50,3 +50,4 @@ obj-$(CONFIG_TI_QSPI) += ti_qspi.o > > obj-$(CONFIG_XILINX_SPI) += xilinx_spi.o > > obj-$(CONFIG_ZYNQ_SPI) += zynq_spi.o > > obj-$(CONFIG_ZYNQ_QSPI) += zynq_qspi.o > > +obj-$(CONFIG_ZYNQMP_QSPI) += zynqmp_qspi.o > > diff --git a/drivers/spi/zynqmp_qspi.c b/drivers/spi/zynqmp_qspi.c new > > file mode 100644 index 0000000..199e704 > > --- /dev/null > > +++ b/drivers/spi/zynqmp_qspi.c > > @@ -0,0 +1,678 @@ > > +/* > > + * (C) Copyright 2014 - 2015 Xilinx > > + * > > + * Xilinx ZynqMP Quad-SPI(QSPI) controller driver (master mode only) > > + * > > + * SPDX-License-Identifier: GPL-2.0 > > + */ > > + > > +#include <common.h> > > +#include <malloc.h> > > +#include <memalign.h> > > +#include <ubi_uboot.h> > > +#include <spi.h> > > +#include <spi_flash.h> > > +#include <asm/io.h> > > +#include <asm/arch/hardware.h> > > +#include <asm/arch/sys_proto.h> > > +#include <asm/arch/clk.h> > > +#include "../mtd/spi/sf_internal.h" > > This I've already commented and still there any reason? > > > +#include <clk.h> > > +#include <asm/arch/zynqmp_qspi.h> > > + > > +DECLARE_GLOBAL_DATA_PTR; > > + > > +struct zynqmp_qspi_platdata { > > + struct zynqmp_qspi_regs *regs; > > + struct zynqmp_qspi_dma_regs *dma_regs; > > + u32 frequency; > > + u32 speed_hz; > > + unsigned int tx_rx_mode; > > +}; > > + > > +struct zynqmp_qspi_priv { > > + struct zynqmp_qspi_regs *regs; > > + struct zynqmp_qspi_dma_regs *dma_regs; > > + u8 mode; > > + const void *tx_buf; > > + void *rx_buf; > > + unsigned int len; > > + int bytes_to_transfer; > > + int bytes_to_receive; > > + unsigned int is_inst; > > + unsigned int cs_change:1; > > +}; > > + > > +static u8 last_cmd; > > + > > +static int zynqmp_qspi_ofdata_to_platdata(struct udevice *bus) { > > + struct zynqmp_qspi_platdata *plat = bus->platdata; > > + u32 mode = 0; > > + u32 value; > > + int ret; > > + struct clk clk; > > + unsigned long clock; > > + > > + debug("%s\n", __func__); > > no need Any issue in having it with debug..?? I can remove if you don’t like. > > > + > > + plat->regs = (struct zynqmp_qspi_regs *)(devfdt_get_addr(bus) + > > + ZYNQMP_GQSPI_REG_OFFSET); > > + plat->dma_regs = (struct zynqmp_qspi_dma_regs *) > > + (devfdt_get_addr(bus) + > > + ZYNQMP_GQSPI_DMA_REG_OFFSET); > > + > > + ret = clk_get_by_index(bus, 0, &clk); > > + if (ret < 0) { > > + dev_err(dev, "failed to get clock\n"); > > + return ret; > > + } > > + > > + clock = clk_get_rate(&clk); > > + if (IS_ERR_VALUE(clock)) { > > + dev_err(dev, "failed to get rate\n"); > > + return clock; > > + } > > + debug("%s: CLK %ld\n", __func__, clock); > > + > > + ret = clk_enable(&clk); > > + if (ret && ret != -ENOSYS) { > > + dev_err(dev, "failed to enable clock\n"); > > + return ret; > > + } > > + > > + value = dev_read_u32_default(bus, "spi-rx-bus-width", 1); > > + switch (value) { > > + case 1: > > + break; > > + case 2: > > + mode |= SPI_RX_DUAL; > > + break; > > + case 4: > > + mode |= SPI_RX_QUAD; > > + break; > > + default: > > + printf("Invalid spi-rx-bus-width %d\n", value); > > + break; > > + } > > + > > + value = dev_read_u32_default(bus, "spi-tx-bus-width", 1); > > + switch (value) { > > + case 1: > > + break; > > + case 2: > > + mode |= SPI_TX_DUAL; > > + break; > > + case 4: > > + mode |= SPI_TX_QUAD; > > + break; > > + default: > > + printf("Invalid spi-tx-bus-width %d\n", value); > > + break; > > + } > > + > > + plat->tx_rx_mode = mode; > > + > > + plat->frequency = clock; > > + plat->speed_hz = plat->frequency; > > why we need this? all these are generic stuff which is available at spi- > uclass.c Somehow I am not able to get these from spi-uclass.c , the routine which reads all these info from dt in spi-uclass.c is never getting invoked in my flow. I checked other driver as well,. Do you have an idea on why is it so? > > > + > > + return 0; > > +} > > + > > +static void zynqmp_qspi_init_hw(struct zynqmp_qspi_priv *priv) { > > + u32 config_reg; > > + struct zynqmp_qspi_regs *regs = priv->regs; > > + > > + writel(ZYNQMP_QSPI_GFIFO_SELECT, ®s->gqspisel); > > + writel(ZYNQMP_QSPI_GFIFO_ALL_INT_MASK, ®s->idisr); > > + writel(ZYNQMP_QSPI_FIFO_THRESHOLD, ®s->txftr); > > + writel(ZYNQMP_QSPI_FIFO_THRESHOLD, ®s->rxftr); > > + writel(ZYNQMP_QSPI_GFIFO_ALL_INT_MASK, ®s->isr); > > + > > + config_reg = readl(®s->confr); > > + config_reg &= ~(ZYNQMP_QSPI_GFIFO_STRT_MODE_MASK | > > + ZYNQMP_QSPI_CONFIG_MODE_EN_MASK); > > + config_reg |= ZYNQMP_QSPI_CONFIG_DMA_MODE | > > + ZYNQMP_QSPI_GFIFO_WP_HOLD | > > + ZYNQMP_QSPI_DFLT_BAUD_RATE_DIV; > > + writel(config_reg, ®s->confr); > > + > > + writel(ZYNQMP_QSPI_ENABLE_ENABLE_MASK, ®s->enbr); } > > + > > +static u32 zynqmp_qspi_bus_select(struct zynqmp_qspi_priv *priv) { > > + u32 gqspi_fifo_reg = 0; > > + > > + gqspi_fifo_reg = ZYNQMP_QSPI_GFIFO_LOW_BUS | > > + ZYNQMP_QSPI_GFIFO_CS_LOWER; > > + > > + return gqspi_fifo_reg; > > +} > > + > > +static void zynqmp_qspi_fill_gen_fifo(struct zynqmp_qspi_priv *priv, > > + u32 gqspi_fifo_reg) { > > + struct zynqmp_qspi_regs *regs = priv->regs; > > + u32 reg; > > + > > + do { > > + reg = readl(®s->isr); > > + } while (!(reg & ZYNQMP_QSPI_IXR_GFEMTY_MASK)); > > infinite loop? use wait_for_bit with definete duration. Sure. > > > + > > + writel(gqspi_fifo_reg, ®s->genfifo); } > > + > > +static void zynqmp_qspi_chipselect(struct zynqmp_qspi_priv *priv, int > > +is_on) { > > + u32 gqspi_fifo_reg = 0; > > + > > + if (is_on) { > > + gqspi_fifo_reg = zynqmp_qspi_bus_select(priv); > > + gqspi_fifo_reg |= ZYNQMP_QSPI_SPI_MODE_SPI | > > + ZYNQMP_QSPI_IMD_DATA_CS_ASSERT; > > + } else { > > + gqspi_fifo_reg = ZYNQMP_QSPI_GFIFO_LOW_BUS; > > + gqspi_fifo_reg |= ZYNQMP_QSPI_IMD_DATA_CS_DEASSERT; > > + } > > + > > + debug("GFIFO_CMD_CS: 0x%x\n", gqspi_fifo_reg); > > + > > + zynqmp_qspi_fill_gen_fifo(priv, gqspi_fifo_reg); } > > + > > +void zynqmp_qspi_set_tapdelay(struct udevice *bus, u32 baudrateval) { > > + struct zynqmp_qspi_platdata *plat = bus->platdata; > > + struct zynqmp_qspi_priv *priv = dev_get_priv(bus); > > + struct zynqmp_qspi_regs *regs = priv->regs; > > + u32 tapdlybypass = 0, lpbkdlyadj = 0, datadlyadj = 0, clk_rate; > > + u32 reqhz = 0; > > + > > + clk_rate = plat->frequency; > > + reqhz = (clk_rate / (GQSPI_BAUD_DIV_SHIFT << baudrateval)); > > + > > + debug("%s, req_hz:%d, clk_rate:%d, baudrateval:%d\n", > > + __func__, reqhz, clk_rate, baudrateval); > > + > > + if (reqhz < GQSPI_FREQ_40MHZ) { > > + zynqmp_mmio_read(IOU_TAPDLY_BYPASS_OFST, > &tapdlybypass); > > + tapdlybypass |= (TAP_DLY_BYPASS_LQSPI_RX_VALUE << > > + TAP_DLY_BYPASS_LQSPI_RX_SHIFT); > > + } else if (reqhz < GQSPI_FREQ_100MHZ) { > > + zynqmp_mmio_read(IOU_TAPDLY_BYPASS_OFST, > &tapdlybypass); > > + tapdlybypass |= (TAP_DLY_BYPASS_LQSPI_RX_VALUE << > > + TAP_DLY_BYPASS_LQSPI_RX_SHIFT); > > + lpbkdlyadj = readl(®s->lpbkdly); > > + lpbkdlyadj |= (GQSPI_LPBK_DLY_ADJ_USE_LPBK_MASK); > > + datadlyadj = readl(®s->gqspidlyadj); > > + datadlyadj |= ((GQSPI_USE_DATA_DLY << > GQSPI_USE_DATA_DLY_SHIFT) > > + | (GQSPI_DATA_DLY_ADJ_VALUE << > > + GQSPI_DATA_DLY_ADJ_SHIFT)); > > + } else if (reqhz < GQSPI_FREQ_150MHZ) { > > + lpbkdlyadj = readl(®s->lpbkdly); > > + lpbkdlyadj |= ((GQSPI_LPBK_DLY_ADJ_USE_LPBK_MASK) | > > + GQSPI_LPBK_DLY_ADJ_DLY_0); > > + } > > + > > + zynqmp_mmio_write(IOU_TAPDLY_BYPASS_OFST, > IOU_TAPDLY_BYPASS_MASK, > > + tapdlybypass); > > + writel(lpbkdlyadj, ®s->lpbkdly); > > + writel(datadlyadj, ®s->gqspidlyadj); } > > + > > +static int zynqmp_qspi_set_speed(struct udevice *bus, uint speed) { > > + struct zynqmp_qspi_platdata *plat = bus->platdata; > > + struct zynqmp_qspi_priv *priv = dev_get_priv(bus); > > + struct zynqmp_qspi_regs *regs = priv->regs; > > + u32 confr; > > + u8 baud_rate_val = 0; > > + > > + debug("%s\n", __func__); > > no need > > > + if (speed > plat->frequency) > > + speed = plat->frequency; > > + > > + /* Set the clock frequency */ > > + confr = readl(®s->confr); > > + if (speed == 0) { > > + /* Set baudrate x8, if the freq is 0 */ > > + baud_rate_val = ZYNQMP_QSPI_DFLT_BAUD_RATE_VAL; > > + } else if (plat->speed_hz != speed) { > > + while ((baud_rate_val < 8) && > > + ((plat->frequency / > > + (2 << baud_rate_val)) > speed)) > > + baud_rate_val++; > > + > > + if (baud_rate_val > ZYNQMP_QSPI_MAX_BAUD_RATE_VAL) > > + baud_rate_val = > > + ZYNQMP_QSPI_DFLT_BAUD_RATE_VAL; > > + > > + plat->speed_hz = plat->frequency / (2 << baud_rate_val); > > + } > > + confr &= ~ZYNQMP_QSPI_BAUD_DIV_MASK; > > + confr |= (baud_rate_val << 3); > > + writel(confr, ®s->confr); > > + > > + zynqmp_qspi_set_tapdelay(bus, baud_rate_val); > > + debug("regs=%p, speed=%d\n", priv->regs, plat->speed_hz); > > + > > + return 0; > > +} > > + > > +static int zynqmp_qspi_child_pre_probe(struct udevice *bus) { > > + struct spi_slave *slave = dev_get_parent_priv(bus); > > + struct zynqmp_qspi_platdata *plat = > > +dev_get_platdata(bus->parent); > > + > > + slave->mode = plat->tx_rx_mode; > > + > > + return 0; > > +} > > mode we can get it from spi-uclass, no need to have this. Same as above comment about spi-uclass.c . > > > + > > +static int zynqmp_qspi_probe(struct udevice *bus) { > > + struct zynqmp_qspi_platdata *plat = dev_get_platdata(bus); > > + struct zynqmp_qspi_priv *priv = dev_get_priv(bus); > > + > > + debug("%s: bus:%p, priv:%p\n", __func__, bus, priv); > > no need > > > + > > + priv->regs = plat->regs; > > + priv->dma_regs = plat->dma_regs; > > + > > + /* init the zynq spi hw */ > > + zynqmp_qspi_init_hw(priv); > > + > > + return 0; > > +} > > + > > +static int zynqmp_qspi_set_mode(struct udevice *bus, uint mode) { > > + struct zynqmp_qspi_priv *priv = dev_get_priv(bus); > > + struct zynqmp_qspi_regs *regs = priv->regs; > > + u32 confr; > > + > > + debug("%s\n", __func__); > > + /* Set the SPI Clock phase and polarities */ > > + confr = readl(®s->confr); > > + confr &= ~(ZYNQMP_QSPI_CONFIG_CPHA_MASK | > > + ZYNQMP_QSPI_CONFIG_CPOL_MASK); > > + > > + if (priv->mode & SPI_CPHA) > > + confr |= ZYNQMP_QSPI_CONFIG_CPHA_MASK; > > + if (priv->mode & SPI_CPOL) > > + confr |= ZYNQMP_QSPI_CONFIG_CPOL_MASK; > > + > > missing confr write? Will check and correct. > > > + priv->mode = mode; > > + > > + debug("regs=%p, mode=%d\n", priv->regs, priv->mode); > > no need > > > + > > + return 0; > > +} > > + > > +static int zynqmp_qspi_fill_tx_fifo(struct zynqmp_qspi_priv *priv, > > +u32 size) { > > + u32 data; > > + u32 timeout = ZYNQMP_QSPI_TIMEOUT; > > + struct zynqmp_qspi_regs *regs = priv->regs; > > + u32 *buf = (u32 *)priv->tx_buf; > > + u32 len = size; > > + > > + debug("TxFIFO: 0x%x, size: 0x%x\n", readl(®s->isr), > > + size); > > + > > + while (size && timeout) { > > + if (readl(®s->isr) & > > + ZYNQMP_QSPI_IXR_TXNFULL_MASK) { > > + if (size >= 4) { > > + writel(*buf, ®s->txd0r); > > + buf++; > > + size -= 4; > > + } else { > > + switch (size) { > > + case 1: > > + data = *((u8 *)buf); > > + buf += 1; > > + data |= 0xFFFFFF00; > > + break; > > + case 2: > > + data = *((u16 *)buf); > > + buf += 2; > > + data |= 0xFFFF0000; > > + break; > > + case 3: > > + data = *((u16 *)buf); > > + buf += 2; > > + data |= (*((u8 *)buf) << 16); > > + buf += 1; > > + data |= 0xFF000000; > > + break; > > + } > > + writel(data, ®s->txd0r); > > + size = 0; > > + } > > + } else { > > + udelay(1); > > + timeout--; > > + } > > + } > > + if (!timeout) { > > + printf("%s: Timeout\n", __func__); > > + return -1; > > + } > > + > > + priv->tx_buf += len; > > + return 0; > > +} > > + > > +static void zynqmp_qspi_genfifo_cmd(struct zynqmp_qspi_priv *priv) { > > + u8 command = 1; > > + u32 gen_fifo_cmd; > > + u32 bytecount = 0; > > + > > + while (priv->len) { > > + gen_fifo_cmd = zynqmp_qspi_bus_select(priv); > > + gen_fifo_cmd |= ZYNQMP_QSPI_GFIFO_TX; > > + > > + if (command) { > > + command = 0; > > + last_cmd = *(u8 *)priv->tx_buf; > > + } > > + > > + gen_fifo_cmd |= ZYNQMP_QSPI_SPI_MODE_SPI; > > + gen_fifo_cmd |= *(u8 *)priv->tx_buf; > > + bytecount++; > > + priv->len--; > > + priv->tx_buf = (u8 *)priv->tx_buf + 1; > > + > > + debug("GFIFO_CMD_Cmd = 0x%x\n", gen_fifo_cmd); > > + > > + zynqmp_qspi_fill_gen_fifo(priv, gen_fifo_cmd); > > + } > > +} > > + > > +static u32 zynqmp_qspi_calc_exp(struct zynqmp_qspi_priv *priv, > > + u32 *gen_fifo_cmd) { > > + u32 expval = 8; > > + u32 len; > > + > > + while (1) { > > + if (priv->len > 255) { > > + if (priv->len & (1 << expval)) { > > + *gen_fifo_cmd &= > ~ZYNQMP_QSPI_GFIFO_IMD_MASK; > > + *gen_fifo_cmd |= ZYNQMP_QSPI_GFIFO_EXP_MASK; > > + *gen_fifo_cmd |= expval; > > + priv->len -= (1 << expval); > > + return expval; > > + } > > + expval++; > > + } else { > > + *gen_fifo_cmd &= ~(ZYNQMP_QSPI_GFIFO_IMD_MASK | > > + ZYNQMP_QSPI_GFIFO_EXP_MASK); > > + *gen_fifo_cmd |= (u8)priv->len; > > + len = (u8)priv->len; > > + priv->len = 0; > > + return len; > > + } > > + } > > +} > > + > > +static int zynqmp_qspi_genfifo_fill_tx(struct zynqmp_qspi_priv *priv) > > +{ > > + u32 gen_fifo_cmd; > > + u32 len; > > + int ret = 0; > > + > > + gen_fifo_cmd = zynqmp_qspi_bus_select(priv); > > + gen_fifo_cmd |= ZYNQMP_QSPI_GFIFO_TX | > > + ZYNQMP_QSPI_GFIFO_DATA_XFR_MASK; > > + > > + if (last_cmd == QUAD_PAGE_PROGRAM_CMD) > > + gen_fifo_cmd |= ZYNQMP_QSPI_SPI_MODE_QSPI; > > + else > > + gen_fifo_cmd |= ZYNQMP_QSPI_SPI_MODE_SPI; > > + > > + while (priv->len) { > > + len = zynqmp_qspi_calc_exp(priv, &gen_fifo_cmd); > > + zynqmp_qspi_fill_gen_fifo(priv, gen_fifo_cmd); > > + > > + debug("GFIFO_CMD_TX:0x%x\n", gen_fifo_cmd); > > + > > + if (gen_fifo_cmd & ZYNQMP_QSPI_GFIFO_EXP_MASK) > > + ret = zynqmp_qspi_fill_tx_fifo(priv, > > + 1 << len); > > + else > > + ret = zynqmp_qspi_fill_tx_fifo(priv, > > + len); > > + > > + if (ret) > > + return ret; > > + } > > + return ret; > > +} > > + > > +static int zynqmp_qspi_start_dma(struct zynqmp_qspi_priv *priv, > > + u32 gen_fifo_cmd, u32 *buf) { > > + u32 addr; > > + u32 size, len; > > + u32 timeout = ZYNQMP_QSPI_TIMEOUT; > > + u32 actuallen = priv->len; > > + struct zynqmp_qspi_dma_regs *dma_regs = priv->dma_regs; > > + > > + writel((unsigned long)buf, &dma_regs->dmadst); > > + writel(roundup(priv->len, 4), &dma_regs->dmasize); > > + writel(ZYNQMP_QSPI_DMA_DST_I_STS_MASK, &dma_regs- > >dmaier); > > + addr = (unsigned long)buf; > > + size = roundup(priv->len, ARCH_DMA_MINALIGN); > > + flush_dcache_range(addr, addr + size); > > + > > + while (priv->len) { > > + len = zynqmp_qspi_calc_exp(priv, &gen_fifo_cmd); > > + if (!(gen_fifo_cmd & ZYNQMP_QSPI_GFIFO_EXP_MASK) && > > + (len % 4)) { > > + gen_fifo_cmd &= ~(0xFF); > > + gen_fifo_cmd |= (len / 4 + 1) * 4; > > + } > > + zynqmp_qspi_fill_gen_fifo(priv, gen_fifo_cmd); > > + > > + debug("GFIFO_CMD_RX:0x%x\n", gen_fifo_cmd); > > + } > > + > > + while (timeout) { > > + if (readl(&dma_regs->dmaisr) & > > + ZYNQMP_QSPI_DMA_DST_I_STS_DONE) { > > + writel(ZYNQMP_QSPI_DMA_DST_I_STS_DONE, > > + &dma_regs->dmaisr); > > + break; > > + } > > + udelay(1); > > + timeout--; > > + } > > wait_for_bit? Ok, will correct. Thanks, Siva > > > + > > + debug("buf:0x%lx, rxbuf:0x%lx, *buf:0x%x len: 0x%x\n", > > + (unsigned long)buf, (unsigned long)priv->rx_buf, *buf, > > + actuallen); > > + if (!timeout) { > > + printf("DMA Timeout:0x%x\n", readl(&dma_regs->dmaisr)); > > + return -1; > > + } > > + > > + if (buf != priv->rx_buf) > > + memcpy(priv->rx_buf, buf, actuallen); > > + > > + return 0; > > +} > > + > > +static int zynqmp_qspi_genfifo_fill_rx(struct zynqmp_qspi_priv *priv) > > +{ > > + u32 gen_fifo_cmd; > > + u32 *buf; > > + u32 actuallen = priv->len; > > + > > + gen_fifo_cmd = zynqmp_qspi_bus_select(priv); > > + gen_fifo_cmd |= ZYNQMP_QSPI_GFIFO_RX | > > + ZYNQMP_QSPI_GFIFO_DATA_XFR_MASK; > > + > > + if (last_cmd == QUAD_OUT_READ_CMD) > > + gen_fifo_cmd |= ZYNQMP_QSPI_SPI_MODE_QSPI; > > + else if (last_cmd == DUAL_OUTPUT_FASTRD_CMD) > > + gen_fifo_cmd |= ZYNQMP_QSPI_SPI_MODE_DUAL_SPI; > > + else > > + gen_fifo_cmd |= ZYNQMP_QSPI_SPI_MODE_SPI; > > + > > + /* > > + * Check if receive buffer is aligned to 4 byte and length > > + * is multiples of four byte as we are using dma to receive. > > + */ > > + if (!((unsigned long)priv->rx_buf & (ZYNQMP_QSPI_DMA_ALIGN - 1)) > && > > + !(actuallen % ZYNQMP_QSPI_DMA_ALIGN)) { > > + buf = (u32 *)priv->rx_buf; > > + return zynqmp_qspi_start_dma(priv, gen_fifo_cmd, buf); > > + } > > + > > + ALLOC_CACHE_ALIGN_BUFFER(u8, tmp, roundup(priv->len, > > + ZYNQMP_QSPI_DMA_ALIGN)); > > + buf = (u32 *)tmp; > > + return zynqmp_qspi_start_dma(priv, gen_fifo_cmd, buf); } > > + > > +static int zynqmp_qspi_start_transfer(struct zynqmp_qspi_priv *priv) > > +{ > > + int ret = 0; > > + > > + if (priv->is_inst) { > > + if (priv->tx_buf) > > + zynqmp_qspi_genfifo_cmd(priv); > > + else > > + ret = -1; > > + } else { > > + if (priv->tx_buf) > > + ret = zynqmp_qspi_genfifo_fill_tx(priv); > > + else if (priv->rx_buf) > > + ret = zynqmp_qspi_genfifo_fill_rx(priv); > > + else > > + ret = -1; > > + } > > + return ret; > > +} > > + > > +static int zynqmp_qspi_transfer(struct zynqmp_qspi_priv *priv) { > > + static unsigned int cs_change = 1; > > + int status = 0; > > + > > + debug("%s\n", __func__); > > + > > + while (1) { > > + /* Select the chip if required */ > > + if (cs_change) > > + zynqmp_qspi_chipselect(priv, 1); > > + > > + cs_change = priv->cs_change; > > + > > + if (!priv->tx_buf && !priv->rx_buf && priv->len) { > > + status = -1; > > + break; > > + } > > + > > + /* Request the transfer */ > > + if (priv->len) { > > + status = zynqmp_qspi_start_transfer(priv); > > + priv->is_inst = 0; > > + if (status < 0) > > + break; > > + } > > + > > + if (cs_change) > > + /* Deselect the chip */ > > + zynqmp_qspi_chipselect(priv, 0); > > + break; > > + } > > + > > + return status; > > +} > > + > > +static int zynqmp_qspi_claim_bus(struct udevice *dev) { > > + struct udevice *bus = dev->parent; > > + struct zynqmp_qspi_priv *priv = dev_get_priv(bus); > > + struct zynqmp_qspi_regs *regs = priv->regs; > > + > > + debug("%s\n", __func__); > > no need > > > + writel(ZYNQMP_QSPI_ENABLE_ENABLE_MASK, ®s->enbr); > > + > > + return 0; > > +} > > + > > +static int zynqmp_qspi_release_bus(struct udevice *dev) { > > + struct udevice *bus = dev->parent; > > + struct zynqmp_qspi_priv *priv = dev_get_priv(bus); > > + struct zynqmp_qspi_regs *regs = priv->regs; > > + > > + debug("%s\n", __func__); > > no need
H Jagan, Any further comments on this. I am waiting for your reply on some of my replies to your comment. Thanks, Siva > -----Original Message----- > From: U-Boot [mailto:u-boot-bounces@lists.denx.de] On Behalf Of Siva > Durga Prasad Paladugu > Sent: Wednesday, February 07, 2018 3:40 PM > To: Jagan Teki <jagan@amarulasolutions.com> > Cc: U-Boot-Denx <u-boot@lists.denx.de> > Subject: Re: [U-Boot] [PATCH v2 1/2] spi: zynqmp_qspi: Add support for > ZynqMP qspi driver > > [This sender failed our fraud detection checks and may not be who they > appear to be. Learn about spoofing at http://aka.ms/LearnAboutSpoofing] > > Hi Jagan, > > > > -----Original Message----- > > From: Jagan Teki [mailto:jagan@amarulasolutions.com] > > Sent: Tuesday, January 23, 2018 10:41 PM > > To: Siva Durga Prasad Paladugu <sivadur@xilinx.com> > > Cc: U-Boot-Denx <u-boot@lists.denx.de>; Siva Durga Prasad Paladugu > > <sivadur@xilinx.com> > > Subject: Re: [U-Boot] [PATCH v2 1/2] spi: zynqmp_qspi: Add support for > > ZynqMP qspi driver > > > > On Thu, Jan 4, 2018 at 1:07 PM, Siva Durga Prasad Paladugu > > <siva.durga.paladugu@xilinx.com> wrote: > > > This patch adds qspi driver support for ZynqMP SoC. This driver is > > > responsible for communicating with qspi flash devices. > > > > > > Signed-off-by: Siva Durga Prasad Paladugu <sivadur@xilinx.com> > > > --- > > > Changes from v1: > > > - Rebased on top of latest master > > > - Moved macro definitions to .h file as per comment > > > - Fixed magic values with macros as per comment > > > --- > > > arch/arm/cpu/armv8/zynqmp/Kconfig | 7 + > > > arch/arm/include/asm/arch-zynqmp/zynqmp_qspi.h | 154 ++++++ > > > drivers/spi/Makefile | 1 + > > > drivers/spi/zynqmp_qspi.c | 678 > > +++++++++++++++++++++++++ > > > > Was this gqspi like linux spi-zynqmp-gqspi.c or different? > Yes. > > > > > > 4 files changed, 840 insertions(+) > > > create mode 100644 arch/arm/include/asm/arch- > > zynqmp/zynqmp_qspi.h > > > create mode 100644 drivers/spi/zynqmp_qspi.c > > > > > > diff --git a/arch/arm/cpu/armv8/zynqmp/Kconfig > > > b/arch/arm/cpu/armv8/zynqmp/Kconfig > > > index 3f922b4..2fe4f71 100644 > > > --- a/arch/arm/cpu/armv8/zynqmp/Kconfig > > > +++ b/arch/arm/cpu/armv8/zynqmp/Kconfig > > > @@ -65,6 +65,13 @@ config PMUFW_INIT_FILE > > > Include external PMUFW (Platform Management Unit FirmWare) > to > > > a Xilinx bootable image (boot.bin). > > > > > > +config ZYNQMP_QSPI > > > + bool "Configure ZynqMP QSPI" > > > + select DM_SPI > > > + help > > > + This option is used to enable ZynqMP QSPI controller driver > which > > > + is used to communicate with qspi flash devices. > > > > I've commented this before, what is the reason for adding spi kconfig > > entry in arch area instead of drivers/spi? > > I might have missed it, Will move to drivers/spi > > > > > + > > > config ZYNQMP_USB > > > bool "Configure ZynqMP USB" > > > > > > diff --git a/arch/arm/include/asm/arch-zynqmp/zynqmp_qspi.h > > > b/arch/arm/include/asm/arch-zynqmp/zynqmp_qspi.h > > > new file mode 100644 > > > index 0000000..5e2926e > > > --- /dev/null > > > +++ b/arch/arm/include/asm/arch-zynqmp/zynqmp_qspi.h > > > @@ -0,0 +1,154 @@ > > > +/* > > > + * (C) Copyright 2014 - 2015 Xilinx > > > + * > > > + * Xilinx ZynqMP Quad-SPI(QSPI) controller driver (master mode > > > +only) > > > + * > > > + * SPDX-License-Identifier: GPL-2.0+ > > > + */ > > > + > > > +#ifndef _ASM_ARCH_ZYNQMP_QSPI_H_ > > > +#define _ASM_ARCH_ZYNQMP_QSPI_H_ > > > + > > > +#define ZYNQMP_QSPI_GFIFO_STRT_MODE_MASK BIT(29) > > > +#define ZYNQMP_QSPI_CONFIG_MODE_EN_MASK (3 << 30) > > > +#define ZYNQMP_QSPI_CONFIG_DMA_MODE (2 << 30) > > > +#define ZYNQMP_QSPI_CONFIG_CPHA_MASK BIT(2) > > > +#define ZYNQMP_QSPI_CONFIG_CPOL_MASK BIT(1) > > > + > > > +/* QSPI MIO's count for different connection topologies */ > > > +#define ZYNQMP_QSPI_MIO_NUM_QSPI0 6 > > > +#define ZYNQMP_QSPI_MIO_NUM_QSPI1 5 > > > +#define ZYNQMP_QSPI_MIO_NUM_QSPI1_CS 1 > > > + > > > +/* > > > + * QSPI Interrupt Registers bit Masks > > > + * > > > + * All the four interrupt registers (Status/Mask/Enable/Disable) > > > +have the same > > > + * bit definitions. > > > + */ > > > +#define ZYNQMP_QSPI_IXR_TXNFULL_MASK 0x00000004 /* QSPI TX > > FIFO Overflow */ > > > +#define ZYNQMP_QSPI_IXR_TXFULL_MASK 0x00000008 /* QSPI TX > > FIFO is full */ > > > +#define ZYNQMP_QSPI_IXR_RXNEMTY_MASK 0x00000010 /* QSPI > RX > > FIFO Not Empty */ > > > +#define ZYNQMP_QSPI_IXR_GFEMTY_MASK 0x00000080 /* QSPI > > Generic FIFO Empty */ > > > +#define ZYNQMP_QSPI_IXR_ALL_MASK > > (ZYNQMP_QSPI_IXR_TXNFULL_MASK | \ > > > + > > > + ZYNQMP_QSPI_IXR_RXNEMTY_MASK) > > > + > > > +/* > > > + * QSPI Enable Register bit Masks > > > + * > > > + * This register is used to enable or disable the QSPI controller > > > +*/ #define ZYNQMP_QSPI_ENABLE_ENABLE_MASK 0x00000001 /* > QSPI > > Enable Bit > > > +Mask */ > > > + > > > +#define ZYNQMP_QSPI_GFIFO_LOW_BUS BIT(14) > > > +#define ZYNQMP_QSPI_GFIFO_CS_LOWER BIT(12) > > > +#define ZYNQMP_QSPI_GFIFO_UP_BUS BIT(15) > > > +#define ZYNQMP_QSPI_GFIFO_CS_UPPER BIT(13) > > > +#define ZYNQMP_QSPI_SPI_MODE_QSPI (3 << 10) > > > +#define ZYNQMP_QSPI_SPI_MODE_SPI BIT(10) > > > +#define ZYNQMP_QSPI_SPI_MODE_DUAL_SPI (2 << 10) > > > +#define ZYNQMP_QSPI_IMD_DATA_CS_ASSERT 5 > > > +#define ZYNQMP_QSPI_IMD_DATA_CS_DEASSERT 5 > > > +#define ZYNQMP_QSPI_GFIFO_TX BIT(16) > > > +#define ZYNQMP_QSPI_GFIFO_RX BIT(17) > > > +#define ZYNQMP_QSPI_GFIFO_STRIPE_MASK BIT(18) > > > +#define ZYNQMP_QSPI_GFIFO_IMD_MASK 0xFF > > > +#define ZYNQMP_QSPI_GFIFO_EXP_MASK BIT(9) > > > +#define ZYNQMP_QSPI_GFIFO_DATA_XFR_MASK BIT(8) > > > +#define ZYNQMP_QSPI_STRT_GEN_FIFO BIT(28) > > > +#define ZYNQMP_QSPI_GEN_FIFO_STRT_MOD BIT(29) > > > +#define ZYNQMP_QSPI_GFIFO_WP_HOLD BIT(19) > > > +#define ZYNQMP_QSPI_BAUD_DIV_MASK (7 << 3) > > > +#define ZYNQMP_QSPI_DFLT_BAUD_RATE_DIV BIT(3) #define > > > +ZYNQMP_QSPI_GFIFO_ALL_INT_MASK 0xFBE #define > > > +ZYNQMP_QSPI_DMA_DST_I_STS_DONE BIT(1) #define > > > +ZYNQMP_QSPI_DMA_DST_I_STS_MASK 0xFE > > > +#define MODEBITS 0x6 > > > + > > > +#define QUAD_OUT_READ_CMD 0x6B > > > +#define QUAD_PAGE_PROGRAM_CMD 0x32 > > > +#define DUAL_OUTPUT_FASTRD_CMD 0x3B > > > + > > > +#define ZYNQMP_QSPI_GFIFO_SELECT BIT(0) > > > + > > > +#define ZYNQMP_QSPI_FIFO_THRESHOLD 1 > > > + > > > +#define SPI_XFER_ON_BOTH 0 > > > +#define SPI_XFER_ON_LOWER 1 > > > +#define SPI_XFER_ON_UPPER 2 > > > + > > > +#define ZYNQMP_QSPI_DMA_ALIGN 0x4 > > > +#define ZYNQMP_QSPI_MAX_BAUD_RATE_VAL 7 #define > > > +ZYNQMP_QSPI_DFLT_BAUD_RATE_VAL 2 > > > + > > > +#define ZYNQMP_QSPI_TIMEOUT 100000000 > > > + > > > +#define GQSPI_BAUD_DIV_SHIFT 2 > > > +#define GQSPI_LPBK_DLY_ADJ_LPBK_SHIFT 5 > > > +#define GQSPI_LPBK_DLY_ADJ_DLY_1 0x2 > > > +#define GQSPI_LPBK_DLY_ADJ_DLY_1_SHIFT 3 > > > +#define GQSPI_LPBK_DLY_ADJ_DLY_0 0x3 > > > +#define GQSPI_USE_DATA_DLY 0x1 > > > +#define GQSPI_USE_DATA_DLY_SHIFT 31 > > > +#define GQSPI_DATA_DLY_ADJ_VALUE 0x2 > > > +#define GQSPI_DATA_DLY_ADJ_SHIFT 28 > > > +#define TAP_DLY_BYPASS_LQSPI_RX_VALUE 0x1 #define > > > +TAP_DLY_BYPASS_LQSPI_RX_SHIFT 2 > > > +#define GQSPI_DATA_DLY_ADJ_OFST 0x000001F8 > > > +#define IOU_TAPDLY_BYPASS_OFST 0xFF180390 > > > +#define GQSPI_LPBK_DLY_ADJ_USE_LPBK_MASK 0x00000020 > > > +#define GQSPI_FREQ_40MHZ 40000000 > > > +#define GQSPI_FREQ_100MHZ 100000000 > > > +#define GQSPI_FREQ_150MHZ 150000000 > > > +#define IOU_TAPDLY_BYPASS_MASK 0x7 > > > + > > > +#define ZYNQMP_GQSPI_REG_OFFSET 0x100 > > > +#define ZYNQMP_GQSPI_DMA_REG_OFFSET 0x800 > > > + > > > +/* QSPI register offsets */ > > > +struct zynqmp_qspi_regs { > > > + u32 confr; /* 0x00 */ > > > + u32 isr; /* 0x04 */ > > > + u32 ier; /* 0x08 */ > > > + u32 idisr; /* 0x0C */ > > > + u32 imaskr; /* 0x10 */ > > > + u32 enbr; /* 0x14 */ > > > + u32 dr; /* 0x18 */ > > > + u32 txd0r; /* 0x1C */ > > > + u32 drxr; /* 0x20 */ > > > + u32 sicr; /* 0x24 */ > > > + u32 txftr; /* 0x28 */ > > > + u32 rxftr; /* 0x2C */ > > > + u32 gpior; /* 0x30 */ > > > + u32 reserved0; /* 0x34 */ > > > + u32 lpbkdly; /* 0x38 */ > > > + u32 reserved1; /* 0x3C */ > > > + u32 genfifo; /* 0x40 */ > > > + u32 gqspisel; /* 0x44 */ > > > + u32 reserved2; /* 0x48 */ > > > + u32 gqfifoctrl; /* 0x4C */ > > > + u32 gqfthr; /* 0x50 */ > > > + u32 gqpollcfg; /* 0x54 */ > > > + u32 gqpollto; /* 0x58 */ > > > + u32 gqxfersts; /* 0x5C */ > > > + u32 gqfifosnap; /* 0x60 */ > > > + u32 gqrxcpy; /* 0x64 */ > > > + u32 reserved3[36]; /* 0x68 */ > > > + u32 gqspidlyadj; /* 0xF8 */ > > > +}; > > > + > > > +struct zynqmp_qspi_dma_regs { > > > + u32 dmadst; /* 0x00 */ > > > + u32 dmasize; /* 0x04 */ > > > + u32 dmasts; /* 0x08 */ > > > + u32 dmactrl; /* 0x0C */ > > > + u32 reserved0; /* 0x10 */ > > > + u32 dmaisr; /* 0x14 */ > > > + u32 dmaier; /* 0x18 */ > > > + u32 dmaidr; /* 0x1C */ > > > + u32 dmaimr; /* 0x20 */ > > > + u32 dmactrl2; /* 0x24 */ > > > + u32 dmadstmsb; /* 0x28 */ > > > +}; > > > + > > > +#endif /* _ASM_ARCH_ZYNQMP_QSPI_H_ */ > > > > Move all these on driver file itself, also try to use short macro names. > > I moved to .h based on v1 comments, now vice versa. I didn’t see any > problem in having these in .h > > > > > > diff --git a/drivers/spi/Makefile b/drivers/spi/Makefile index > > > e3184db..9cdd94a 100644 > > > --- a/drivers/spi/Makefile > > > +++ b/drivers/spi/Makefile > > > @@ -50,3 +50,4 @@ obj-$(CONFIG_TI_QSPI) += ti_qspi.o > > > obj-$(CONFIG_XILINX_SPI) += xilinx_spi.o > > > obj-$(CONFIG_ZYNQ_SPI) += zynq_spi.o > > > obj-$(CONFIG_ZYNQ_QSPI) += zynq_qspi.o > > > +obj-$(CONFIG_ZYNQMP_QSPI) += zynqmp_qspi.o > > > diff --git a/drivers/spi/zynqmp_qspi.c b/drivers/spi/zynqmp_qspi.c > > > new file mode 100644 index 0000000..199e704 > > > --- /dev/null > > > +++ b/drivers/spi/zynqmp_qspi.c > > > @@ -0,0 +1,678 @@ > > > +/* > > > + * (C) Copyright 2014 - 2015 Xilinx > > > + * > > > + * Xilinx ZynqMP Quad-SPI(QSPI) controller driver (master mode > > > +only) > > > + * > > > + * SPDX-License-Identifier: GPL-2.0 > > > + */ > > > + > > > +#include <common.h> > > > +#include <malloc.h> > > > +#include <memalign.h> > > > +#include <ubi_uboot.h> > > > +#include <spi.h> > > > +#include <spi_flash.h> > > > +#include <asm/io.h> > > > +#include <asm/arch/hardware.h> > > > +#include <asm/arch/sys_proto.h> > > > +#include <asm/arch/clk.h> > > > +#include "../mtd/spi/sf_internal.h" > > > > This I've already commented and still there any reason? > > > > > +#include <clk.h> > > > +#include <asm/arch/zynqmp_qspi.h> > > > + > > > +DECLARE_GLOBAL_DATA_PTR; > > > + > > > +struct zynqmp_qspi_platdata { > > > + struct zynqmp_qspi_regs *regs; > > > + struct zynqmp_qspi_dma_regs *dma_regs; > > > + u32 frequency; > > > + u32 speed_hz; > > > + unsigned int tx_rx_mode; > > > +}; > > > + > > > +struct zynqmp_qspi_priv { > > > + struct zynqmp_qspi_regs *regs; > > > + struct zynqmp_qspi_dma_regs *dma_regs; > > > + u8 mode; > > > + const void *tx_buf; > > > + void *rx_buf; > > > + unsigned int len; > > > + int bytes_to_transfer; > > > + int bytes_to_receive; > > > + unsigned int is_inst; > > > + unsigned int cs_change:1; > > > +}; > > > + > > > +static u8 last_cmd; > > > + > > > +static int zynqmp_qspi_ofdata_to_platdata(struct udevice *bus) { > > > + struct zynqmp_qspi_platdata *plat = bus->platdata; > > > + u32 mode = 0; > > > + u32 value; > > > + int ret; > > > + struct clk clk; > > > + unsigned long clock; > > > + > > > + debug("%s\n", __func__); > > > > no need > > Any issue in having it with debug..?? I can remove if you don’t like. > > > > > + > > > + plat->regs = (struct zynqmp_qspi_regs *)(devfdt_get_addr(bus) + > > > + ZYNQMP_GQSPI_REG_OFFSET); > > > + plat->dma_regs = (struct zynqmp_qspi_dma_regs *) > > > + (devfdt_get_addr(bus) + > > > + ZYNQMP_GQSPI_DMA_REG_OFFSET); > > > + > > > + ret = clk_get_by_index(bus, 0, &clk); > > > + if (ret < 0) { > > > + dev_err(dev, "failed to get clock\n"); > > > + return ret; > > > + } > > > + > > > + clock = clk_get_rate(&clk); > > > + if (IS_ERR_VALUE(clock)) { > > > + dev_err(dev, "failed to get rate\n"); > > > + return clock; > > > + } > > > + debug("%s: CLK %ld\n", __func__, clock); > > > + > > > + ret = clk_enable(&clk); > > > + if (ret && ret != -ENOSYS) { > > > + dev_err(dev, "failed to enable clock\n"); > > > + return ret; > > > + } > > > + > > > + value = dev_read_u32_default(bus, "spi-rx-bus-width", 1); > > > + switch (value) { > > > + case 1: > > > + break; > > > + case 2: > > > + mode |= SPI_RX_DUAL; > > > + break; > > > + case 4: > > > + mode |= SPI_RX_QUAD; > > > + break; > > > + default: > > > + printf("Invalid spi-rx-bus-width %d\n", value); > > > + break; > > > + } > > > + > > > + value = dev_read_u32_default(bus, "spi-tx-bus-width", 1); > > > + switch (value) { > > > + case 1: > > > + break; > > > + case 2: > > > + mode |= SPI_TX_DUAL; > > > + break; > > > + case 4: > > > + mode |= SPI_TX_QUAD; > > > + break; > > > + default: > > > + printf("Invalid spi-tx-bus-width %d\n", value); > > > + break; > > > + } > > > + > > > + plat->tx_rx_mode = mode; > > > + > > > + plat->frequency = clock; > > > + plat->speed_hz = plat->frequency; > > > > why we need this? all these are generic stuff which is available at > > spi- uclass.c > > Somehow I am not able to get these from spi-uclass.c , the routine which > reads all these info from dt in spi-uclass.c is never getting invoked in my > flow. > I checked other driver as well,. Do you have an idea on why is it so? > > > > > > + > > > + return 0; > > > +} > > > + > > > +static void zynqmp_qspi_init_hw(struct zynqmp_qspi_priv *priv) { > > > + u32 config_reg; > > > + struct zynqmp_qspi_regs *regs = priv->regs; > > > + > > > + writel(ZYNQMP_QSPI_GFIFO_SELECT, ®s->gqspisel); > > > + writel(ZYNQMP_QSPI_GFIFO_ALL_INT_MASK, ®s->idisr); > > > + writel(ZYNQMP_QSPI_FIFO_THRESHOLD, ®s->txftr); > > > + writel(ZYNQMP_QSPI_FIFO_THRESHOLD, ®s->rxftr); > > > + writel(ZYNQMP_QSPI_GFIFO_ALL_INT_MASK, ®s->isr); > > > + > > > + config_reg = readl(®s->confr); > > > + config_reg &= ~(ZYNQMP_QSPI_GFIFO_STRT_MODE_MASK | > > > + ZYNQMP_QSPI_CONFIG_MODE_EN_MASK); > > > + config_reg |= ZYNQMP_QSPI_CONFIG_DMA_MODE | > > > + ZYNQMP_QSPI_GFIFO_WP_HOLD | > > > + ZYNQMP_QSPI_DFLT_BAUD_RATE_DIV; > > > + writel(config_reg, ®s->confr); > > > + > > > + writel(ZYNQMP_QSPI_ENABLE_ENABLE_MASK, ®s->enbr); } > > > + > > > +static u32 zynqmp_qspi_bus_select(struct zynqmp_qspi_priv *priv) { > > > + u32 gqspi_fifo_reg = 0; > > > + > > > + gqspi_fifo_reg = ZYNQMP_QSPI_GFIFO_LOW_BUS | > > > + ZYNQMP_QSPI_GFIFO_CS_LOWER; > > > + > > > + return gqspi_fifo_reg; > > > +} > > > + > > > +static void zynqmp_qspi_fill_gen_fifo(struct zynqmp_qspi_priv *priv, > > > + u32 gqspi_fifo_reg) { > > > + struct zynqmp_qspi_regs *regs = priv->regs; > > > + u32 reg; > > > + > > > + do { > > > + reg = readl(®s->isr); > > > + } while (!(reg & ZYNQMP_QSPI_IXR_GFEMTY_MASK)); > > > > infinite loop? use wait_for_bit with definete duration. > Sure. > > > > > > + > > > + writel(gqspi_fifo_reg, ®s->genfifo); } > > > + > > > +static void zynqmp_qspi_chipselect(struct zynqmp_qspi_priv *priv, > > > +int > > > +is_on) { > > > + u32 gqspi_fifo_reg = 0; > > > + > > > + if (is_on) { > > > + gqspi_fifo_reg = zynqmp_qspi_bus_select(priv); > > > + gqspi_fifo_reg |= ZYNQMP_QSPI_SPI_MODE_SPI | > > > + ZYNQMP_QSPI_IMD_DATA_CS_ASSERT; > > > + } else { > > > + gqspi_fifo_reg = ZYNQMP_QSPI_GFIFO_LOW_BUS; > > > + gqspi_fifo_reg |= ZYNQMP_QSPI_IMD_DATA_CS_DEASSERT; > > > + } > > > + > > > + debug("GFIFO_CMD_CS: 0x%x\n", gqspi_fifo_reg); > > > + > > > + zynqmp_qspi_fill_gen_fifo(priv, gqspi_fifo_reg); } > > > + > > > +void zynqmp_qspi_set_tapdelay(struct udevice *bus, u32 > baudrateval) { > > > + struct zynqmp_qspi_platdata *plat = bus->platdata; > > > + struct zynqmp_qspi_priv *priv = dev_get_priv(bus); > > > + struct zynqmp_qspi_regs *regs = priv->regs; > > > + u32 tapdlybypass = 0, lpbkdlyadj = 0, datadlyadj = 0, clk_rate; > > > + u32 reqhz = 0; > > > + > > > + clk_rate = plat->frequency; > > > + reqhz = (clk_rate / (GQSPI_BAUD_DIV_SHIFT << baudrateval)); > > > + > > > + debug("%s, req_hz:%d, clk_rate:%d, baudrateval:%d\n", > > > + __func__, reqhz, clk_rate, baudrateval); > > > + > > > + if (reqhz < GQSPI_FREQ_40MHZ) { > > > + zynqmp_mmio_read(IOU_TAPDLY_BYPASS_OFST, > > &tapdlybypass); > > > + tapdlybypass |= (TAP_DLY_BYPASS_LQSPI_RX_VALUE << > > > + TAP_DLY_BYPASS_LQSPI_RX_SHIFT); > > > + } else if (reqhz < GQSPI_FREQ_100MHZ) { > > > + zynqmp_mmio_read(IOU_TAPDLY_BYPASS_OFST, > > &tapdlybypass); > > > + tapdlybypass |= (TAP_DLY_BYPASS_LQSPI_RX_VALUE << > > > + TAP_DLY_BYPASS_LQSPI_RX_SHIFT); > > > + lpbkdlyadj = readl(®s->lpbkdly); > > > + lpbkdlyadj |= (GQSPI_LPBK_DLY_ADJ_USE_LPBK_MASK); > > > + datadlyadj = readl(®s->gqspidlyadj); > > > + datadlyadj |= ((GQSPI_USE_DATA_DLY << > > GQSPI_USE_DATA_DLY_SHIFT) > > > + | (GQSPI_DATA_DLY_ADJ_VALUE << > > > + GQSPI_DATA_DLY_ADJ_SHIFT)); > > > + } else if (reqhz < GQSPI_FREQ_150MHZ) { > > > + lpbkdlyadj = readl(®s->lpbkdly); > > > + lpbkdlyadj |= ((GQSPI_LPBK_DLY_ADJ_USE_LPBK_MASK) | > > > + GQSPI_LPBK_DLY_ADJ_DLY_0); > > > + } > > > + > > > + zynqmp_mmio_write(IOU_TAPDLY_BYPASS_OFST, > > IOU_TAPDLY_BYPASS_MASK, > > > + tapdlybypass); > > > + writel(lpbkdlyadj, ®s->lpbkdly); > > > + writel(datadlyadj, ®s->gqspidlyadj); } > > > + > > > +static int zynqmp_qspi_set_speed(struct udevice *bus, uint speed) { > > > + struct zynqmp_qspi_platdata *plat = bus->platdata; > > > + struct zynqmp_qspi_priv *priv = dev_get_priv(bus); > > > + struct zynqmp_qspi_regs *regs = priv->regs; > > > + u32 confr; > > > + u8 baud_rate_val = 0; > > > + > > > + debug("%s\n", __func__); > > > > no need > > > > > + if (speed > plat->frequency) > > > + speed = plat->frequency; > > > + > > > + /* Set the clock frequency */ > > > + confr = readl(®s->confr); > > > + if (speed == 0) { > > > + /* Set baudrate x8, if the freq is 0 */ > > > + baud_rate_val = ZYNQMP_QSPI_DFLT_BAUD_RATE_VAL; > > > + } else if (plat->speed_hz != speed) { > > > + while ((baud_rate_val < 8) && > > > + ((plat->frequency / > > > + (2 << baud_rate_val)) > speed)) > > > + baud_rate_val++; > > > + > > > + if (baud_rate_val > ZYNQMP_QSPI_MAX_BAUD_RATE_VAL) > > > + baud_rate_val = > > > + ZYNQMP_QSPI_DFLT_BAUD_RATE_VAL; > > > + > > > + plat->speed_hz = plat->frequency / (2 << baud_rate_val); > > > + } > > > + confr &= ~ZYNQMP_QSPI_BAUD_DIV_MASK; > > > + confr |= (baud_rate_val << 3); > > > + writel(confr, ®s->confr); > > > + > > > + zynqmp_qspi_set_tapdelay(bus, baud_rate_val); > > > + debug("regs=%p, speed=%d\n", priv->regs, plat->speed_hz); > > > + > > > + return 0; > > > +} > > > + > > > +static int zynqmp_qspi_child_pre_probe(struct udevice *bus) { > > > + struct spi_slave *slave = dev_get_parent_priv(bus); > > > + struct zynqmp_qspi_platdata *plat = > > > +dev_get_platdata(bus->parent); > > > + > > > + slave->mode = plat->tx_rx_mode; > > > + > > > + return 0; > > > +} > > > > mode we can get it from spi-uclass, no need to have this. > > Same as above comment about spi-uclass.c . > > > > > > + > > > +static int zynqmp_qspi_probe(struct udevice *bus) { > > > + struct zynqmp_qspi_platdata *plat = dev_get_platdata(bus); > > > + struct zynqmp_qspi_priv *priv = dev_get_priv(bus); > > > + > > > + debug("%s: bus:%p, priv:%p\n", __func__, bus, priv); > > > > no need > > > > > + > > > + priv->regs = plat->regs; > > > + priv->dma_regs = plat->dma_regs; > > > + > > > + /* init the zynq spi hw */ > > > + zynqmp_qspi_init_hw(priv); > > > + > > > + return 0; > > > +} > > > + > > > +static int zynqmp_qspi_set_mode(struct udevice *bus, uint mode) { > > > + struct zynqmp_qspi_priv *priv = dev_get_priv(bus); > > > + struct zynqmp_qspi_regs *regs = priv->regs; > > > + u32 confr; > > > + > > > + debug("%s\n", __func__); > > > + /* Set the SPI Clock phase and polarities */ > > > + confr = readl(®s->confr); > > > + confr &= ~(ZYNQMP_QSPI_CONFIG_CPHA_MASK | > > > + ZYNQMP_QSPI_CONFIG_CPOL_MASK); > > > + > > > + if (priv->mode & SPI_CPHA) > > > + confr |= ZYNQMP_QSPI_CONFIG_CPHA_MASK; > > > + if (priv->mode & SPI_CPOL) > > > + confr |= ZYNQMP_QSPI_CONFIG_CPOL_MASK; > > > + > > > > missing confr write? > Will check and correct. > > > > > + priv->mode = mode; > > > + > > > + debug("regs=%p, mode=%d\n", priv->regs, priv->mode); > > > > no need > > > > > + > > > + return 0; > > > +} > > > + > > > +static int zynqmp_qspi_fill_tx_fifo(struct zynqmp_qspi_priv *priv, > > > +u32 size) { > > > + u32 data; > > > + u32 timeout = ZYNQMP_QSPI_TIMEOUT; > > > + struct zynqmp_qspi_regs *regs = priv->regs; > > > + u32 *buf = (u32 *)priv->tx_buf; > > > + u32 len = size; > > > + > > > + debug("TxFIFO: 0x%x, size: 0x%x\n", readl(®s->isr), > > > + size); > > > + > > > + while (size && timeout) { > > > + if (readl(®s->isr) & > > > + ZYNQMP_QSPI_IXR_TXNFULL_MASK) { > > > + if (size >= 4) { > > > + writel(*buf, ®s->txd0r); > > > + buf++; > > > + size -= 4; > > > + } else { > > > + switch (size) { > > > + case 1: > > > + data = *((u8 *)buf); > > > + buf += 1; > > > + data |= 0xFFFFFF00; > > > + break; > > > + case 2: > > > + data = *((u16 *)buf); > > > + buf += 2; > > > + data |= 0xFFFF0000; > > > + break; > > > + case 3: > > > + data = *((u16 *)buf); > > > + buf += 2; > > > + data |= (*((u8 *)buf) << 16); > > > + buf += 1; > > > + data |= 0xFF000000; > > > + break; > > > + } > > > + writel(data, ®s->txd0r); > > > + size = 0; > > > + } > > > + } else { > > > + udelay(1); > > > + timeout--; > > > + } > > > + } > > > + if (!timeout) { > > > + printf("%s: Timeout\n", __func__); > > > + return -1; > > > + } > > > + > > > + priv->tx_buf += len; > > > + return 0; > > > +} > > > + > > > +static void zynqmp_qspi_genfifo_cmd(struct zynqmp_qspi_priv *priv) > { > > > + u8 command = 1; > > > + u32 gen_fifo_cmd; > > > + u32 bytecount = 0; > > > + > > > + while (priv->len) { > > > + gen_fifo_cmd = zynqmp_qspi_bus_select(priv); > > > + gen_fifo_cmd |= ZYNQMP_QSPI_GFIFO_TX; > > > + > > > + if (command) { > > > + command = 0; > > > + last_cmd = *(u8 *)priv->tx_buf; > > > + } > > > + > > > + gen_fifo_cmd |= ZYNQMP_QSPI_SPI_MODE_SPI; > > > + gen_fifo_cmd |= *(u8 *)priv->tx_buf; > > > + bytecount++; > > > + priv->len--; > > > + priv->tx_buf = (u8 *)priv->tx_buf + 1; > > > + > > > + debug("GFIFO_CMD_Cmd = 0x%x\n", gen_fifo_cmd); > > > + > > > + zynqmp_qspi_fill_gen_fifo(priv, gen_fifo_cmd); > > > + } > > > +} > > > + > > > +static u32 zynqmp_qspi_calc_exp(struct zynqmp_qspi_priv *priv, > > > + u32 *gen_fifo_cmd) { > > > + u32 expval = 8; > > > + u32 len; > > > + > > > + while (1) { > > > + if (priv->len > 255) { > > > + if (priv->len & (1 << expval)) { > > > + *gen_fifo_cmd &= > > ~ZYNQMP_QSPI_GFIFO_IMD_MASK; > > > + *gen_fifo_cmd |= > ZYNQMP_QSPI_GFIFO_EXP_MASK; > > > + *gen_fifo_cmd |= expval; > > > + priv->len -= (1 << expval); > > > + return expval; > > > + } > > > + expval++; > > > + } else { > > > + *gen_fifo_cmd &= ~(ZYNQMP_QSPI_GFIFO_IMD_MASK > | > > > + ZYNQMP_QSPI_GFIFO_EXP_MASK); > > > + *gen_fifo_cmd |= (u8)priv->len; > > > + len = (u8)priv->len; > > > + priv->len = 0; > > > + return len; > > > + } > > > + } > > > +} > > > + > > > +static int zynqmp_qspi_genfifo_fill_tx(struct zynqmp_qspi_priv > > > +*priv) { > > > + u32 gen_fifo_cmd; > > > + u32 len; > > > + int ret = 0; > > > + > > > + gen_fifo_cmd = zynqmp_qspi_bus_select(priv); > > > + gen_fifo_cmd |= ZYNQMP_QSPI_GFIFO_TX | > > > + ZYNQMP_QSPI_GFIFO_DATA_XFR_MASK; > > > + > > > + if (last_cmd == QUAD_PAGE_PROGRAM_CMD) > > > + gen_fifo_cmd |= ZYNQMP_QSPI_SPI_MODE_QSPI; > > > + else > > > + gen_fifo_cmd |= ZYNQMP_QSPI_SPI_MODE_SPI; > > > + > > > + while (priv->len) { > > > + len = zynqmp_qspi_calc_exp(priv, &gen_fifo_cmd); > > > + zynqmp_qspi_fill_gen_fifo(priv, gen_fifo_cmd); > > > + > > > + debug("GFIFO_CMD_TX:0x%x\n", gen_fifo_cmd); > > > + > > > + if (gen_fifo_cmd & ZYNQMP_QSPI_GFIFO_EXP_MASK) > > > + ret = zynqmp_qspi_fill_tx_fifo(priv, > > > + 1 << len); > > > + else > > > + ret = zynqmp_qspi_fill_tx_fifo(priv, > > > + len); > > > + > > > + if (ret) > > > + return ret; > > > + } > > > + return ret; > > > +} > > > + > > > +static int zynqmp_qspi_start_dma(struct zynqmp_qspi_priv *priv, > > > + u32 gen_fifo_cmd, u32 *buf) { > > > + u32 addr; > > > + u32 size, len; > > > + u32 timeout = ZYNQMP_QSPI_TIMEOUT; > > > + u32 actuallen = priv->len; > > > + struct zynqmp_qspi_dma_regs *dma_regs = priv->dma_regs; > > > + > > > + writel((unsigned long)buf, &dma_regs->dmadst); > > > + writel(roundup(priv->len, 4), &dma_regs->dmasize); > > > + writel(ZYNQMP_QSPI_DMA_DST_I_STS_MASK, &dma_regs- > > >dmaier); > > > + addr = (unsigned long)buf; > > > + size = roundup(priv->len, ARCH_DMA_MINALIGN); > > > + flush_dcache_range(addr, addr + size); > > > + > > > + while (priv->len) { > > > + len = zynqmp_qspi_calc_exp(priv, &gen_fifo_cmd); > > > + if (!(gen_fifo_cmd & ZYNQMP_QSPI_GFIFO_EXP_MASK) && > > > + (len % 4)) { > > > + gen_fifo_cmd &= ~(0xFF); > > > + gen_fifo_cmd |= (len / 4 + 1) * 4; > > > + } > > > + zynqmp_qspi_fill_gen_fifo(priv, gen_fifo_cmd); > > > + > > > + debug("GFIFO_CMD_RX:0x%x\n", gen_fifo_cmd); > > > + } > > > + > > > + while (timeout) { > > > + if (readl(&dma_regs->dmaisr) & > > > + ZYNQMP_QSPI_DMA_DST_I_STS_DONE) { > > > + writel(ZYNQMP_QSPI_DMA_DST_I_STS_DONE, > > > + &dma_regs->dmaisr); > > > + break; > > > + } > > > + udelay(1); > > > + timeout--; > > > + } > > > > wait_for_bit? > > Ok, will correct. > > > Thanks, > Siva > > > > > > + > > > + debug("buf:0x%lx, rxbuf:0x%lx, *buf:0x%x len: 0x%x\n", > > > + (unsigned long)buf, (unsigned long)priv->rx_buf, *buf, > > > + actuallen); > > > + if (!timeout) { > > > + printf("DMA Timeout:0x%x\n", readl(&dma_regs->dmaisr)); > > > + return -1; > > > + } > > > + > > > + if (buf != priv->rx_buf) > > > + memcpy(priv->rx_buf, buf, actuallen); > > > + > > > + return 0; > > > +} > > > + > > > +static int zynqmp_qspi_genfifo_fill_rx(struct zynqmp_qspi_priv > > > +*priv) { > > > + u32 gen_fifo_cmd; > > > + u32 *buf; > > > + u32 actuallen = priv->len; > > > + > > > + gen_fifo_cmd = zynqmp_qspi_bus_select(priv); > > > + gen_fifo_cmd |= ZYNQMP_QSPI_GFIFO_RX | > > > + ZYNQMP_QSPI_GFIFO_DATA_XFR_MASK; > > > + > > > + if (last_cmd == QUAD_OUT_READ_CMD) > > > + gen_fifo_cmd |= ZYNQMP_QSPI_SPI_MODE_QSPI; > > > + else if (last_cmd == DUAL_OUTPUT_FASTRD_CMD) > > > + gen_fifo_cmd |= ZYNQMP_QSPI_SPI_MODE_DUAL_SPI; > > > + else > > > + gen_fifo_cmd |= ZYNQMP_QSPI_SPI_MODE_SPI; > > > + > > > + /* > > > + * Check if receive buffer is aligned to 4 byte and length > > > + * is multiples of four byte as we are using dma to receive. > > > + */ > > > + if (!((unsigned long)priv->rx_buf & (ZYNQMP_QSPI_DMA_ALIGN - > > > + 1)) > > && > > > + !(actuallen % ZYNQMP_QSPI_DMA_ALIGN)) { > > > + buf = (u32 *)priv->rx_buf; > > > + return zynqmp_qspi_start_dma(priv, gen_fifo_cmd, buf); > > > + } > > > + > > > + ALLOC_CACHE_ALIGN_BUFFER(u8, tmp, roundup(priv->len, > > > + ZYNQMP_QSPI_DMA_ALIGN)); > > > + buf = (u32 *)tmp; > > > + return zynqmp_qspi_start_dma(priv, gen_fifo_cmd, buf); } > > > + > > > +static int zynqmp_qspi_start_transfer(struct zynqmp_qspi_priv > > > +*priv) { > > > + int ret = 0; > > > + > > > + if (priv->is_inst) { > > > + if (priv->tx_buf) > > > + zynqmp_qspi_genfifo_cmd(priv); > > > + else > > > + ret = -1; > > > + } else { > > > + if (priv->tx_buf) > > > + ret = zynqmp_qspi_genfifo_fill_tx(priv); > > > + else if (priv->rx_buf) > > > + ret = zynqmp_qspi_genfifo_fill_rx(priv); > > > + else > > > + ret = -1; > > > + } > > > + return ret; > > > +} > > > + > > > +static int zynqmp_qspi_transfer(struct zynqmp_qspi_priv *priv) { > > > + static unsigned int cs_change = 1; > > > + int status = 0; > > > + > > > + debug("%s\n", __func__); > > > + > > > + while (1) { > > > + /* Select the chip if required */ > > > + if (cs_change) > > > + zynqmp_qspi_chipselect(priv, 1); > > > + > > > + cs_change = priv->cs_change; > > > + > > > + if (!priv->tx_buf && !priv->rx_buf && priv->len) { > > > + status = -1; > > > + break; > > > + } > > > + > > > + /* Request the transfer */ > > > + if (priv->len) { > > > + status = zynqmp_qspi_start_transfer(priv); > > > + priv->is_inst = 0; > > > + if (status < 0) > > > + break; > > > + } > > > + > > > + if (cs_change) > > > + /* Deselect the chip */ > > > + zynqmp_qspi_chipselect(priv, 0); > > > + break; > > > + } > > > + > > > + return status; > > > +} > > > + > > > +static int zynqmp_qspi_claim_bus(struct udevice *dev) { > > > + struct udevice *bus = dev->parent; > > > + struct zynqmp_qspi_priv *priv = dev_get_priv(bus); > > > + struct zynqmp_qspi_regs *regs = priv->regs; > > > + > > > + debug("%s\n", __func__); > > > > no need > > > > > + writel(ZYNQMP_QSPI_ENABLE_ENABLE_MASK, ®s->enbr); > > > + > > > + return 0; > > > +} > > > + > > > +static int zynqmp_qspi_release_bus(struct udevice *dev) { > > > + struct udevice *bus = dev->parent; > > > + struct zynqmp_qspi_priv *priv = dev_get_priv(bus); > > > + struct zynqmp_qspi_regs *regs = priv->regs; > > > + > > > + debug("%s\n", __func__); > > > > no need > _______________________________________________ > U-Boot mailing list > U-Boot@lists.denx.de > https://lists.denx.de/listinfo/u-boot
Hi Siva, I've been working on a patch to add support for io-mode [1]. It's based on xilinx/master which is closer to v1 (no include file). I haven't had much time to test it further but I can load a bitstream from a ubifs partition with it. Let me know if you have comments. On Tue, 10 Apr 2018 at 02:27 Siva Durga Prasad Paladugu <sivadur@xilinx.com> wrote: > H Jagan, > > Any further comments on this. I am waiting for your reply on some of my > replies to your comment. > > Thanks, > Siva > > Thanks, Liam [1] https://github.com/Liambeguin/u-boot/tree/io-mode
Hi Liam,
We already have a patch for IO mode that we just verified internally. We got it for our tree from NGC guy John Moon. I will be sending that patch soon may be with v3 which I am planning to send once I got response from Jagan on my v2 queries.
Regards,
Siva
From: Liam Beguin [mailto:liambeguin@gmail.com]
Sent: Tuesday, April 10, 2018 8:56 PM
To: Siva Durga Prasad Paladugu <sivadur@xilinx.com>
Cc: Jagan Teki <jagan@amarulasolutions.com>; U-Boot-Denx <u-boot@lists.denx.de>; Michal Simek <michal.simek@xilinx.com>
Subject: Re: [U-Boot] [PATCH v2 1/2] spi: zynqmp_qspi: Add support for ZynqMP qspi driver
Hi Siva,
I've been working on a patch to add support for io-mode [1].
It's based on xilinx/master which is closer to v1 (no include file).
I haven't had much time to test it further but I can load a bitstream
from a ubifs partition with it.
Let me know if you have comments.
On Tue, 10 Apr 2018 at 02:27 Siva Durga Prasad Paladugu <sivadur@xilinx.com<mailto:sivadur@xilinx.com>> wrote:
H Jagan,
Any further comments on this. I am waiting for your reply on some of my replies to your comment.
Thanks,
Siva
Thanks,
Liam
[1] https://github.com/Liambeguin/u-boot/tree/io-mode
Hi Siva, I wasn't able to find it on the Xilinx github. Is it in that tree already? Thanks, Liam On Thu, 12 Apr 2018 at 07:18 Siva Durga Prasad Paladugu <sivadur@xilinx.com> wrote: > Hi Liam, > > > > We already have a patch for IO mode that we just verified internally. We > got it for our tree from NGC guy John Moon. I will be sending that patch > soon may be with v3 which I am planning to send once I got response from > Jagan on my v2 queries. > > > > Regards, > > Siva > > > > *From:* Liam Beguin [mailto:liambeguin@gmail.com] > *Sent:* Tuesday, April 10, 2018 8:56 PM > *To:* Siva Durga Prasad Paladugu <sivadur@xilinx.com> > *Cc:* Jagan Teki <jagan@amarulasolutions.com>; U-Boot-Denx < > u-boot@lists.denx.de>; Michal Simek <michal.simek@xilinx.com> > > > *Subject:* Re: [U-Boot] [PATCH v2 1/2] spi: zynqmp_qspi: Add support for > ZynqMP qspi driver > > > > Hi Siva, > > > > I've been working on a patch to add support for io-mode [1]. > > It's based on xilinx/master which is closer to v1 (no include file). > > I haven't had much time to test it further but I can load a bitstream > > from a ubifs partition with it. > > Let me know if you have comments. > > > > On Tue, 10 Apr 2018 at 02:27 Siva Durga Prasad Paladugu < > sivadur@xilinx.com> wrote: > > H Jagan, > > Any further comments on this. I am waiting for your reply on some of my > replies to your comment. > > Thanks, > Siva > > > > Thanks, > > Liam > > > > [1] https://github.com/Liambeguin/u-boot/tree/io-mode >
On Wed, Feb 7, 2018 at 3:40 PM, Siva Durga Prasad Paladugu <sivadur@xilinx.com> wrote: > Hi Jagan, > > >> -----Original Message----- >> From: Jagan Teki [mailto:jagan@amarulasolutions.com] >> Sent: Tuesday, January 23, 2018 10:41 PM >> To: Siva Durga Prasad Paladugu <sivadur@xilinx.com> >> Cc: U-Boot-Denx <u-boot@lists.denx.de>; Siva Durga Prasad Paladugu >> <sivadur@xilinx.com> >> Subject: Re: [U-Boot] [PATCH v2 1/2] spi: zynqmp_qspi: Add support for >> ZynqMP qspi driver >> >> On Thu, Jan 4, 2018 at 1:07 PM, Siva Durga Prasad Paladugu >> <siva.durga.paladugu@xilinx.com> wrote: >> > This patch adds qspi driver support for ZynqMP SoC. This driver is >> > responsible for communicating with qspi flash devices. >> > >> > Signed-off-by: Siva Durga Prasad Paladugu <sivadur@xilinx.com> >> > --- >> > Changes from v1: >> > - Rebased on top of latest master >> > - Moved macro definitions to .h file as per comment >> > - Fixed magic values with macros as per comment >> > --- >> > arch/arm/cpu/armv8/zynqmp/Kconfig | 7 + >> > arch/arm/include/asm/arch-zynqmp/zynqmp_qspi.h | 154 ++++++ >> > drivers/spi/Makefile | 1 + >> > drivers/spi/zynqmp_qspi.c | 678 >> +++++++++++++++++++++++++ >> >> Was this gqspi like linux spi-zynqmp-gqspi.c or different? > Yes. then try to use similar naming conventions in macros, or in function names as well. > >> >> > 4 files changed, 840 insertions(+) >> > create mode 100644 arch/arm/include/asm/arch- >> zynqmp/zynqmp_qspi.h >> > create mode 100644 drivers/spi/zynqmp_qspi.c >> > >> > diff --git a/arch/arm/cpu/armv8/zynqmp/Kconfig >> > b/arch/arm/cpu/armv8/zynqmp/Kconfig >> > index 3f922b4..2fe4f71 100644 >> > --- a/arch/arm/cpu/armv8/zynqmp/Kconfig >> > +++ b/arch/arm/cpu/armv8/zynqmp/Kconfig >> > @@ -65,6 +65,13 @@ config PMUFW_INIT_FILE >> > Include external PMUFW (Platform Management Unit FirmWare) to >> > a Xilinx bootable image (boot.bin). >> > >> > +config ZYNQMP_QSPI >> > + bool "Configure ZynqMP QSPI" >> > + select DM_SPI >> > + help >> > + This option is used to enable ZynqMP QSPI controller driver which >> > + is used to communicate with qspi flash devices. >> >> I've commented this before, what is the reason for adding spi kconfig entry >> in arch area instead of drivers/spi? > > I might have missed it, Will move to drivers/spi >> >> > + >> > config ZYNQMP_USB >> > bool "Configure ZynqMP USB" >> > >> > diff --git a/arch/arm/include/asm/arch-zynqmp/zynqmp_qspi.h >> > b/arch/arm/include/asm/arch-zynqmp/zynqmp_qspi.h >> > new file mode 100644 >> > index 0000000..5e2926e >> > --- /dev/null >> > +++ b/arch/arm/include/asm/arch-zynqmp/zynqmp_qspi.h >> > @@ -0,0 +1,154 @@ >> > +/* >> > + * (C) Copyright 2014 - 2015 Xilinx >> > + * >> > + * Xilinx ZynqMP Quad-SPI(QSPI) controller driver (master mode only) >> > + * >> > + * SPDX-License-Identifier: GPL-2.0+ >> > + */ >> > + >> > +#ifndef _ASM_ARCH_ZYNQMP_QSPI_H_ >> > +#define _ASM_ARCH_ZYNQMP_QSPI_H_ >> > + >> > +#define ZYNQMP_QSPI_GFIFO_STRT_MODE_MASK BIT(29) >> > +#define ZYNQMP_QSPI_CONFIG_MODE_EN_MASK (3 << 30) >> > +#define ZYNQMP_QSPI_CONFIG_DMA_MODE (2 << 30) >> > +#define ZYNQMP_QSPI_CONFIG_CPHA_MASK BIT(2) >> > +#define ZYNQMP_QSPI_CONFIG_CPOL_MASK BIT(1) >> > + >> > +/* QSPI MIO's count for different connection topologies */ >> > +#define ZYNQMP_QSPI_MIO_NUM_QSPI0 6 >> > +#define ZYNQMP_QSPI_MIO_NUM_QSPI1 5 >> > +#define ZYNQMP_QSPI_MIO_NUM_QSPI1_CS 1 >> > + >> > +/* >> > + * QSPI Interrupt Registers bit Masks >> > + * >> > + * All the four interrupt registers (Status/Mask/Enable/Disable) have >> > +the same >> > + * bit definitions. >> > + */ >> > +#define ZYNQMP_QSPI_IXR_TXNFULL_MASK 0x00000004 /* QSPI TX >> FIFO Overflow */ >> > +#define ZYNQMP_QSPI_IXR_TXFULL_MASK 0x00000008 /* QSPI TX >> FIFO is full */ >> > +#define ZYNQMP_QSPI_IXR_RXNEMTY_MASK 0x00000010 /* QSPI RX >> FIFO Not Empty */ >> > +#define ZYNQMP_QSPI_IXR_GFEMTY_MASK 0x00000080 /* QSPI >> Generic FIFO Empty */ >> > +#define ZYNQMP_QSPI_IXR_ALL_MASK >> (ZYNQMP_QSPI_IXR_TXNFULL_MASK | \ >> > + ZYNQMP_QSPI_IXR_RXNEMTY_MASK) >> > + >> > +/* >> > + * QSPI Enable Register bit Masks >> > + * >> > + * This register is used to enable or disable the QSPI controller */ >> > +#define ZYNQMP_QSPI_ENABLE_ENABLE_MASK 0x00000001 /* QSPI >> Enable Bit >> > +Mask */ >> > + >> > +#define ZYNQMP_QSPI_GFIFO_LOW_BUS BIT(14) >> > +#define ZYNQMP_QSPI_GFIFO_CS_LOWER BIT(12) >> > +#define ZYNQMP_QSPI_GFIFO_UP_BUS BIT(15) >> > +#define ZYNQMP_QSPI_GFIFO_CS_UPPER BIT(13) >> > +#define ZYNQMP_QSPI_SPI_MODE_QSPI (3 << 10) >> > +#define ZYNQMP_QSPI_SPI_MODE_SPI BIT(10) >> > +#define ZYNQMP_QSPI_SPI_MODE_DUAL_SPI (2 << 10) >> > +#define ZYNQMP_QSPI_IMD_DATA_CS_ASSERT 5 >> > +#define ZYNQMP_QSPI_IMD_DATA_CS_DEASSERT 5 >> > +#define ZYNQMP_QSPI_GFIFO_TX BIT(16) >> > +#define ZYNQMP_QSPI_GFIFO_RX BIT(17) >> > +#define ZYNQMP_QSPI_GFIFO_STRIPE_MASK BIT(18) >> > +#define ZYNQMP_QSPI_GFIFO_IMD_MASK 0xFF >> > +#define ZYNQMP_QSPI_GFIFO_EXP_MASK BIT(9) >> > +#define ZYNQMP_QSPI_GFIFO_DATA_XFR_MASK BIT(8) >> > +#define ZYNQMP_QSPI_STRT_GEN_FIFO BIT(28) >> > +#define ZYNQMP_QSPI_GEN_FIFO_STRT_MOD BIT(29) >> > +#define ZYNQMP_QSPI_GFIFO_WP_HOLD BIT(19) >> > +#define ZYNQMP_QSPI_BAUD_DIV_MASK (7 << 3) >> > +#define ZYNQMP_QSPI_DFLT_BAUD_RATE_DIV BIT(3) #define >> > +ZYNQMP_QSPI_GFIFO_ALL_INT_MASK 0xFBE #define >> > +ZYNQMP_QSPI_DMA_DST_I_STS_DONE BIT(1) #define >> > +ZYNQMP_QSPI_DMA_DST_I_STS_MASK 0xFE >> > +#define MODEBITS 0x6 >> > + >> > +#define QUAD_OUT_READ_CMD 0x6B >> > +#define QUAD_PAGE_PROGRAM_CMD 0x32 >> > +#define DUAL_OUTPUT_FASTRD_CMD 0x3B >> > + >> > +#define ZYNQMP_QSPI_GFIFO_SELECT BIT(0) >> > + >> > +#define ZYNQMP_QSPI_FIFO_THRESHOLD 1 >> > + >> > +#define SPI_XFER_ON_BOTH 0 >> > +#define SPI_XFER_ON_LOWER 1 >> > +#define SPI_XFER_ON_UPPER 2 >> > + >> > +#define ZYNQMP_QSPI_DMA_ALIGN 0x4 >> > +#define ZYNQMP_QSPI_MAX_BAUD_RATE_VAL 7 #define >> > +ZYNQMP_QSPI_DFLT_BAUD_RATE_VAL 2 >> > + >> > +#define ZYNQMP_QSPI_TIMEOUT 100000000 >> > + >> > +#define GQSPI_BAUD_DIV_SHIFT 2 >> > +#define GQSPI_LPBK_DLY_ADJ_LPBK_SHIFT 5 >> > +#define GQSPI_LPBK_DLY_ADJ_DLY_1 0x2 >> > +#define GQSPI_LPBK_DLY_ADJ_DLY_1_SHIFT 3 >> > +#define GQSPI_LPBK_DLY_ADJ_DLY_0 0x3 >> > +#define GQSPI_USE_DATA_DLY 0x1 >> > +#define GQSPI_USE_DATA_DLY_SHIFT 31 >> > +#define GQSPI_DATA_DLY_ADJ_VALUE 0x2 >> > +#define GQSPI_DATA_DLY_ADJ_SHIFT 28 >> > +#define TAP_DLY_BYPASS_LQSPI_RX_VALUE 0x1 #define >> > +TAP_DLY_BYPASS_LQSPI_RX_SHIFT 2 >> > +#define GQSPI_DATA_DLY_ADJ_OFST 0x000001F8 >> > +#define IOU_TAPDLY_BYPASS_OFST 0xFF180390 >> > +#define GQSPI_LPBK_DLY_ADJ_USE_LPBK_MASK 0x00000020 >> > +#define GQSPI_FREQ_40MHZ 40000000 >> > +#define GQSPI_FREQ_100MHZ 100000000 >> > +#define GQSPI_FREQ_150MHZ 150000000 >> > +#define IOU_TAPDLY_BYPASS_MASK 0x7 >> > + >> > +#define ZYNQMP_GQSPI_REG_OFFSET 0x100 >> > +#define ZYNQMP_GQSPI_DMA_REG_OFFSET 0x800 >> > + >> > +/* QSPI register offsets */ >> > +struct zynqmp_qspi_regs { >> > + u32 confr; /* 0x00 */ >> > + u32 isr; /* 0x04 */ >> > + u32 ier; /* 0x08 */ >> > + u32 idisr; /* 0x0C */ >> > + u32 imaskr; /* 0x10 */ >> > + u32 enbr; /* 0x14 */ >> > + u32 dr; /* 0x18 */ >> > + u32 txd0r; /* 0x1C */ >> > + u32 drxr; /* 0x20 */ >> > + u32 sicr; /* 0x24 */ >> > + u32 txftr; /* 0x28 */ >> > + u32 rxftr; /* 0x2C */ >> > + u32 gpior; /* 0x30 */ >> > + u32 reserved0; /* 0x34 */ >> > + u32 lpbkdly; /* 0x38 */ >> > + u32 reserved1; /* 0x3C */ >> > + u32 genfifo; /* 0x40 */ >> > + u32 gqspisel; /* 0x44 */ >> > + u32 reserved2; /* 0x48 */ >> > + u32 gqfifoctrl; /* 0x4C */ >> > + u32 gqfthr; /* 0x50 */ >> > + u32 gqpollcfg; /* 0x54 */ >> > + u32 gqpollto; /* 0x58 */ >> > + u32 gqxfersts; /* 0x5C */ >> > + u32 gqfifosnap; /* 0x60 */ >> > + u32 gqrxcpy; /* 0x64 */ >> > + u32 reserved3[36]; /* 0x68 */ >> > + u32 gqspidlyadj; /* 0xF8 */ >> > +}; >> > + >> > +struct zynqmp_qspi_dma_regs { >> > + u32 dmadst; /* 0x00 */ >> > + u32 dmasize; /* 0x04 */ >> > + u32 dmasts; /* 0x08 */ >> > + u32 dmactrl; /* 0x0C */ >> > + u32 reserved0; /* 0x10 */ >> > + u32 dmaisr; /* 0x14 */ >> > + u32 dmaier; /* 0x18 */ >> > + u32 dmaidr; /* 0x1C */ >> > + u32 dmaimr; /* 0x20 */ >> > + u32 dmactrl2; /* 0x24 */ >> > + u32 dmadstmsb; /* 0x28 */ >> > +}; >> > + >> > +#endif /* _ASM_ARCH_ZYNQMP_QSPI_H_ */ >> >> Move all these on driver file itself, also try to use short macro names. > > I moved to .h based on v1 comments, now vice versa. I didn’t see any problem in having these in .h > >> >> > diff --git a/drivers/spi/Makefile b/drivers/spi/Makefile index >> > e3184db..9cdd94a 100644 >> > --- a/drivers/spi/Makefile >> > +++ b/drivers/spi/Makefile >> > @@ -50,3 +50,4 @@ obj-$(CONFIG_TI_QSPI) += ti_qspi.o >> > obj-$(CONFIG_XILINX_SPI) += xilinx_spi.o >> > obj-$(CONFIG_ZYNQ_SPI) += zynq_spi.o >> > obj-$(CONFIG_ZYNQ_QSPI) += zynq_qspi.o >> > +obj-$(CONFIG_ZYNQMP_QSPI) += zynqmp_qspi.o >> > diff --git a/drivers/spi/zynqmp_qspi.c b/drivers/spi/zynqmp_qspi.c new >> > file mode 100644 index 0000000..199e704 >> > --- /dev/null >> > +++ b/drivers/spi/zynqmp_qspi.c >> > @@ -0,0 +1,678 @@ >> > +/* >> > + * (C) Copyright 2014 - 2015 Xilinx >> > + * >> > + * Xilinx ZynqMP Quad-SPI(QSPI) controller driver (master mode only) >> > + * >> > + * SPDX-License-Identifier: GPL-2.0 >> > + */ >> > + >> > +#include <common.h> >> > +#include <malloc.h> >> > +#include <memalign.h> >> > +#include <ubi_uboot.h> >> > +#include <spi.h> >> > +#include <spi_flash.h> >> > +#include <asm/io.h> >> > +#include <asm/arch/hardware.h> >> > +#include <asm/arch/sys_proto.h> >> > +#include <asm/arch/clk.h> >> > +#include "../mtd/spi/sf_internal.h" >> >> This I've already commented and still there any reason? >> >> > +#include <clk.h> >> > +#include <asm/arch/zynqmp_qspi.h> >> > + >> > +DECLARE_GLOBAL_DATA_PTR; >> > + >> > +struct zynqmp_qspi_platdata { >> > + struct zynqmp_qspi_regs *regs; >> > + struct zynqmp_qspi_dma_regs *dma_regs; >> > + u32 frequency; >> > + u32 speed_hz; >> > + unsigned int tx_rx_mode; >> > +}; >> > + >> > +struct zynqmp_qspi_priv { >> > + struct zynqmp_qspi_regs *regs; >> > + struct zynqmp_qspi_dma_regs *dma_regs; >> > + u8 mode; >> > + const void *tx_buf; >> > + void *rx_buf; >> > + unsigned int len; >> > + int bytes_to_transfer; >> > + int bytes_to_receive; >> > + unsigned int is_inst; >> > + unsigned int cs_change:1; >> > +}; >> > + >> > +static u8 last_cmd; >> > + >> > +static int zynqmp_qspi_ofdata_to_platdata(struct udevice *bus) { >> > + struct zynqmp_qspi_platdata *plat = bus->platdata; >> > + u32 mode = 0; >> > + u32 value; >> > + int ret; >> > + struct clk clk; >> > + unsigned long clock; >> > + >> > + debug("%s\n", __func__); >> >> no need > > Any issue in having it with debug..?? I can remove if you don’t like. >> >> > + >> > + plat->regs = (struct zynqmp_qspi_regs *)(devfdt_get_addr(bus) + >> > + ZYNQMP_GQSPI_REG_OFFSET); >> > + plat->dma_regs = (struct zynqmp_qspi_dma_regs *) >> > + (devfdt_get_addr(bus) + >> > + ZYNQMP_GQSPI_DMA_REG_OFFSET); >> > + >> > + ret = clk_get_by_index(bus, 0, &clk); >> > + if (ret < 0) { >> > + dev_err(dev, "failed to get clock\n"); >> > + return ret; >> > + } >> > + >> > + clock = clk_get_rate(&clk); >> > + if (IS_ERR_VALUE(clock)) { >> > + dev_err(dev, "failed to get rate\n"); >> > + return clock; >> > + } >> > + debug("%s: CLK %ld\n", __func__, clock); >> > + >> > + ret = clk_enable(&clk); >> > + if (ret && ret != -ENOSYS) { >> > + dev_err(dev, "failed to enable clock\n"); >> > + return ret; >> > + } >> > + >> > + value = dev_read_u32_default(bus, "spi-rx-bus-width", 1); >> > + switch (value) { >> > + case 1: >> > + break; >> > + case 2: >> > + mode |= SPI_RX_DUAL; >> > + break; >> > + case 4: >> > + mode |= SPI_RX_QUAD; >> > + break; >> > + default: >> > + printf("Invalid spi-rx-bus-width %d\n", value); >> > + break; >> > + } >> > + >> > + value = dev_read_u32_default(bus, "spi-tx-bus-width", 1); >> > + switch (value) { >> > + case 1: >> > + break; >> > + case 2: >> > + mode |= SPI_TX_DUAL; >> > + break; >> > + case 4: >> > + mode |= SPI_TX_QUAD; >> > + break; >> > + default: >> > + printf("Invalid spi-tx-bus-width %d\n", value); >> > + break; >> > + } >> > + >> > + plat->tx_rx_mode = mode; >> > + >> > + plat->frequency = clock; >> > + plat->speed_hz = plat->frequency; >> >> why we need this? all these are generic stuff which is available at spi- >> uclass.c > > Somehow I am not able to get these from spi-uclass.c , the routine which reads all these info from dt in spi-uclass.c is never getting invoked in my flow. > I checked other driver as well,. Do you have an idea on why is it so? All these attributes are from platdata which were initialized by spi-uclass.c so if you need any of these we can get the dm_spi_slave_platdata from your driver using dev_get_parent_platdata() function. Remeber let not add spi-nor features in this driver, you may ended-up more adding more redundent code in driver if you do so. Fix, what ever comments you agree and resend we will review again. Jagan.
Hi, > -----Original Message----- > From: Jagan Teki [mailto:jagan@amarulasolutions.com] > Sent: Wednesday, April 25, 2018 10:47 AM > To: Siva Durga Prasad Paladugu <sivadur@xilinx.com> > Cc: U-Boot-Denx <u-boot@lists.denx.de> > Subject: Re: [U-Boot] [PATCH v2 1/2] spi: zynqmp_qspi: Add support for > ZynqMP qspi driver > > On Wed, Feb 7, 2018 at 3:40 PM, Siva Durga Prasad Paladugu > <sivadur@xilinx.com> wrote: > > Hi Jagan, > > > > > >> -----Original Message----- > >> From: Jagan Teki [mailto:jagan@amarulasolutions.com] > >> Sent: Tuesday, January 23, 2018 10:41 PM > >> To: Siva Durga Prasad Paladugu <sivadur@xilinx.com> > >> Cc: U-Boot-Denx <u-boot@lists.denx.de>; Siva Durga Prasad Paladugu > >> <sivadur@xilinx.com> > >> Subject: Re: [U-Boot] [PATCH v2 1/2] spi: zynqmp_qspi: Add support > >> for ZynqMP qspi driver > >> > >> On Thu, Jan 4, 2018 at 1:07 PM, Siva Durga Prasad Paladugu > >> <siva.durga.paladugu@xilinx.com> wrote: > >> > This patch adds qspi driver support for ZynqMP SoC. This driver is > >> > responsible for communicating with qspi flash devices. > >> > > >> > Signed-off-by: Siva Durga Prasad Paladugu <sivadur@xilinx.com> > >> > --- > >> > Changes from v1: > >> > - Rebased on top of latest master > >> > - Moved macro definitions to .h file as per comment > >> > - Fixed magic values with macros as per comment > >> > --- > >> > arch/arm/cpu/armv8/zynqmp/Kconfig | 7 + > >> > arch/arm/include/asm/arch-zynqmp/zynqmp_qspi.h | 154 ++++++ > >> > drivers/spi/Makefile | 1 + > >> > drivers/spi/zynqmp_qspi.c | 678 > >> +++++++++++++++++++++++++ > >> > >> Was this gqspi like linux spi-zynqmp-gqspi.c or different? > > Yes. > > then try to use similar naming conventions in macros, or in function names > as well. > > > > >> > >> > 4 files changed, 840 insertions(+) create mode 100644 > >> > arch/arm/include/asm/arch- > >> zynqmp/zynqmp_qspi.h > >> > create mode 100644 drivers/spi/zynqmp_qspi.c > >> > > >> > diff --git a/arch/arm/cpu/armv8/zynqmp/Kconfig > >> > b/arch/arm/cpu/armv8/zynqmp/Kconfig > >> > index 3f922b4..2fe4f71 100644 > >> > --- a/arch/arm/cpu/armv8/zynqmp/Kconfig > >> > +++ b/arch/arm/cpu/armv8/zynqmp/Kconfig > >> > @@ -65,6 +65,13 @@ config PMUFW_INIT_FILE > >> > Include external PMUFW (Platform Management Unit FirmWare) > to > >> > a Xilinx bootable image (boot.bin). > >> > > >> > +config ZYNQMP_QSPI > >> > + bool "Configure ZynqMP QSPI" > >> > + select DM_SPI > >> > + help > >> > + This option is used to enable ZynqMP QSPI controller driver > which > >> > + is used to communicate with qspi flash devices. > >> > >> I've commented this before, what is the reason for adding spi kconfig > >> entry in arch area instead of drivers/spi? > > > > I might have missed it, Will move to drivers/spi > >> > >> > + > >> > config ZYNQMP_USB > >> > bool "Configure ZynqMP USB" > >> > > >> > diff --git a/arch/arm/include/asm/arch-zynqmp/zynqmp_qspi.h > >> > b/arch/arm/include/asm/arch-zynqmp/zynqmp_qspi.h > >> > new file mode 100644 > >> > index 0000000..5e2926e > >> > --- /dev/null > >> > +++ b/arch/arm/include/asm/arch-zynqmp/zynqmp_qspi.h > >> > @@ -0,0 +1,154 @@ > >> > +/* > >> > + * (C) Copyright 2014 - 2015 Xilinx > >> > + * > >> > + * Xilinx ZynqMP Quad-SPI(QSPI) controller driver (master mode > >> > +only) > >> > + * > >> > + * SPDX-License-Identifier: GPL-2.0+ > >> > + */ > >> > + > >> > +#ifndef _ASM_ARCH_ZYNQMP_QSPI_H_ > >> > +#define _ASM_ARCH_ZYNQMP_QSPI_H_ > >> > + > >> > +#define ZYNQMP_QSPI_GFIFO_STRT_MODE_MASK BIT(29) > >> > +#define ZYNQMP_QSPI_CONFIG_MODE_EN_MASK (3 << 30) > >> > +#define ZYNQMP_QSPI_CONFIG_DMA_MODE (2 << 30) > >> > +#define ZYNQMP_QSPI_CONFIG_CPHA_MASK BIT(2) > >> > +#define ZYNQMP_QSPI_CONFIG_CPOL_MASK BIT(1) > >> > + > >> > +/* QSPI MIO's count for different connection topologies */ > >> > +#define ZYNQMP_QSPI_MIO_NUM_QSPI0 6 > >> > +#define ZYNQMP_QSPI_MIO_NUM_QSPI1 5 > >> > +#define ZYNQMP_QSPI_MIO_NUM_QSPI1_CS 1 > >> > + > >> > +/* > >> > + * QSPI Interrupt Registers bit Masks > >> > + * > >> > + * All the four interrupt registers (Status/Mask/Enable/Disable) > >> > +have the same > >> > + * bit definitions. > >> > + */ > >> > +#define ZYNQMP_QSPI_IXR_TXNFULL_MASK 0x00000004 /* QSPI > TX > >> FIFO Overflow */ > >> > +#define ZYNQMP_QSPI_IXR_TXFULL_MASK 0x00000008 /* QSPI TX > >> FIFO is full */ > >> > +#define ZYNQMP_QSPI_IXR_RXNEMTY_MASK 0x00000010 /* QSPI > RX > >> FIFO Not Empty */ > >> > +#define ZYNQMP_QSPI_IXR_GFEMTY_MASK 0x00000080 /* QSPI > >> Generic FIFO Empty */ > >> > +#define ZYNQMP_QSPI_IXR_ALL_MASK > >> (ZYNQMP_QSPI_IXR_TXNFULL_MASK | \ > >> > + > >> > + ZYNQMP_QSPI_IXR_RXNEMTY_MASK) > >> > + > >> > +/* > >> > + * QSPI Enable Register bit Masks > >> > + * > >> > + * This register is used to enable or disable the QSPI controller > >> > +*/ #define ZYNQMP_QSPI_ENABLE_ENABLE_MASK 0x00000001 /* > QSPI > >> Enable Bit > >> > +Mask */ > >> > + > >> > +#define ZYNQMP_QSPI_GFIFO_LOW_BUS BIT(14) > >> > +#define ZYNQMP_QSPI_GFIFO_CS_LOWER BIT(12) > >> > +#define ZYNQMP_QSPI_GFIFO_UP_BUS BIT(15) > >> > +#define ZYNQMP_QSPI_GFIFO_CS_UPPER BIT(13) > >> > +#define ZYNQMP_QSPI_SPI_MODE_QSPI (3 << 10) > >> > +#define ZYNQMP_QSPI_SPI_MODE_SPI BIT(10) > >> > +#define ZYNQMP_QSPI_SPI_MODE_DUAL_SPI (2 << 10) > >> > +#define ZYNQMP_QSPI_IMD_DATA_CS_ASSERT 5 > >> > +#define ZYNQMP_QSPI_IMD_DATA_CS_DEASSERT 5 > >> > +#define ZYNQMP_QSPI_GFIFO_TX BIT(16) > >> > +#define ZYNQMP_QSPI_GFIFO_RX BIT(17) > >> > +#define ZYNQMP_QSPI_GFIFO_STRIPE_MASK BIT(18) > >> > +#define ZYNQMP_QSPI_GFIFO_IMD_MASK 0xFF > >> > +#define ZYNQMP_QSPI_GFIFO_EXP_MASK BIT(9) > >> > +#define ZYNQMP_QSPI_GFIFO_DATA_XFR_MASK BIT(8) > >> > +#define ZYNQMP_QSPI_STRT_GEN_FIFO BIT(28) > >> > +#define ZYNQMP_QSPI_GEN_FIFO_STRT_MOD BIT(29) > >> > +#define ZYNQMP_QSPI_GFIFO_WP_HOLD BIT(19) > >> > +#define ZYNQMP_QSPI_BAUD_DIV_MASK (7 << 3) > >> > +#define ZYNQMP_QSPI_DFLT_BAUD_RATE_DIV BIT(3) #define > >> > +ZYNQMP_QSPI_GFIFO_ALL_INT_MASK 0xFBE #define > >> > +ZYNQMP_QSPI_DMA_DST_I_STS_DONE BIT(1) #define > >> > +ZYNQMP_QSPI_DMA_DST_I_STS_MASK 0xFE > >> > +#define MODEBITS 0x6 > >> > + > >> > +#define QUAD_OUT_READ_CMD 0x6B > >> > +#define QUAD_PAGE_PROGRAM_CMD 0x32 > >> > +#define DUAL_OUTPUT_FASTRD_CMD 0x3B > >> > + > >> > +#define ZYNQMP_QSPI_GFIFO_SELECT BIT(0) > >> > + > >> > +#define ZYNQMP_QSPI_FIFO_THRESHOLD 1 > >> > + > >> > +#define SPI_XFER_ON_BOTH 0 > >> > +#define SPI_XFER_ON_LOWER 1 > >> > +#define SPI_XFER_ON_UPPER 2 > >> > + > >> > +#define ZYNQMP_QSPI_DMA_ALIGN 0x4 #define > >> > +ZYNQMP_QSPI_MAX_BAUD_RATE_VAL 7 #define > >> > +ZYNQMP_QSPI_DFLT_BAUD_RATE_VAL 2 > >> > + > >> > +#define ZYNQMP_QSPI_TIMEOUT 100000000 > >> > + > >> > +#define GQSPI_BAUD_DIV_SHIFT 2 > >> > +#define GQSPI_LPBK_DLY_ADJ_LPBK_SHIFT 5 > >> > +#define GQSPI_LPBK_DLY_ADJ_DLY_1 0x2 > >> > +#define GQSPI_LPBK_DLY_ADJ_DLY_1_SHIFT 3 > >> > +#define GQSPI_LPBK_DLY_ADJ_DLY_0 0x3 > >> > +#define GQSPI_USE_DATA_DLY 0x1 > >> > +#define GQSPI_USE_DATA_DLY_SHIFT 31 > >> > +#define GQSPI_DATA_DLY_ADJ_VALUE 0x2 > >> > +#define GQSPI_DATA_DLY_ADJ_SHIFT 28 > >> > +#define TAP_DLY_BYPASS_LQSPI_RX_VALUE 0x1 #define > >> > +TAP_DLY_BYPASS_LQSPI_RX_SHIFT 2 > >> > +#define GQSPI_DATA_DLY_ADJ_OFST 0x000001F8 > >> > +#define IOU_TAPDLY_BYPASS_OFST 0xFF180390 > >> > +#define GQSPI_LPBK_DLY_ADJ_USE_LPBK_MASK 0x00000020 > >> > +#define GQSPI_FREQ_40MHZ 40000000 > >> > +#define GQSPI_FREQ_100MHZ 100000000 > >> > +#define GQSPI_FREQ_150MHZ 150000000 > >> > +#define IOU_TAPDLY_BYPASS_MASK 0x7 > >> > + > >> > +#define ZYNQMP_GQSPI_REG_OFFSET 0x100 > >> > +#define ZYNQMP_GQSPI_DMA_REG_OFFSET 0x800 > >> > + > >> > +/* QSPI register offsets */ > >> > +struct zynqmp_qspi_regs { > >> > + u32 confr; /* 0x00 */ > >> > + u32 isr; /* 0x04 */ > >> > + u32 ier; /* 0x08 */ > >> > + u32 idisr; /* 0x0C */ > >> > + u32 imaskr; /* 0x10 */ > >> > + u32 enbr; /* 0x14 */ > >> > + u32 dr; /* 0x18 */ > >> > + u32 txd0r; /* 0x1C */ > >> > + u32 drxr; /* 0x20 */ > >> > + u32 sicr; /* 0x24 */ > >> > + u32 txftr; /* 0x28 */ > >> > + u32 rxftr; /* 0x2C */ > >> > + u32 gpior; /* 0x30 */ > >> > + u32 reserved0; /* 0x34 */ > >> > + u32 lpbkdly; /* 0x38 */ > >> > + u32 reserved1; /* 0x3C */ > >> > + u32 genfifo; /* 0x40 */ > >> > + u32 gqspisel; /* 0x44 */ > >> > + u32 reserved2; /* 0x48 */ > >> > + u32 gqfifoctrl; /* 0x4C */ > >> > + u32 gqfthr; /* 0x50 */ > >> > + u32 gqpollcfg; /* 0x54 */ > >> > + u32 gqpollto; /* 0x58 */ > >> > + u32 gqxfersts; /* 0x5C */ > >> > + u32 gqfifosnap; /* 0x60 */ > >> > + u32 gqrxcpy; /* 0x64 */ > >> > + u32 reserved3[36]; /* 0x68 */ > >> > + u32 gqspidlyadj; /* 0xF8 */ > >> > +}; > >> > + > >> > +struct zynqmp_qspi_dma_regs { > >> > + u32 dmadst; /* 0x00 */ > >> > + u32 dmasize; /* 0x04 */ > >> > + u32 dmasts; /* 0x08 */ > >> > + u32 dmactrl; /* 0x0C */ > >> > + u32 reserved0; /* 0x10 */ > >> > + u32 dmaisr; /* 0x14 */ > >> > + u32 dmaier; /* 0x18 */ > >> > + u32 dmaidr; /* 0x1C */ > >> > + u32 dmaimr; /* 0x20 */ > >> > + u32 dmactrl2; /* 0x24 */ > >> > + u32 dmadstmsb; /* 0x28 */ > >> > +}; > >> > + > >> > +#endif /* _ASM_ARCH_ZYNQMP_QSPI_H_ */ > >> > >> Move all these on driver file itself, also try to use short macro names. > > > > I moved to .h based on v1 comments, now vice versa. I didn’t see any > > problem in having these in .h > > > >> > >> > diff --git a/drivers/spi/Makefile b/drivers/spi/Makefile index > >> > e3184db..9cdd94a 100644 > >> > --- a/drivers/spi/Makefile > >> > +++ b/drivers/spi/Makefile > >> > @@ -50,3 +50,4 @@ obj-$(CONFIG_TI_QSPI) += ti_qspi.o > >> > obj-$(CONFIG_XILINX_SPI) += xilinx_spi.o > >> > obj-$(CONFIG_ZYNQ_SPI) += zynq_spi.o > >> > obj-$(CONFIG_ZYNQ_QSPI) += zynq_qspi.o > >> > +obj-$(CONFIG_ZYNQMP_QSPI) += zynqmp_qspi.o > >> > diff --git a/drivers/spi/zynqmp_qspi.c b/drivers/spi/zynqmp_qspi.c > >> > new file mode 100644 index 0000000..199e704 > >> > --- /dev/null > >> > +++ b/drivers/spi/zynqmp_qspi.c > >> > @@ -0,0 +1,678 @@ > >> > +/* > >> > + * (C) Copyright 2014 - 2015 Xilinx > >> > + * > >> > + * Xilinx ZynqMP Quad-SPI(QSPI) controller driver (master mode > >> > +only) > >> > + * > >> > + * SPDX-License-Identifier: GPL-2.0 > >> > + */ > >> > + > >> > +#include <common.h> > >> > +#include <malloc.h> > >> > +#include <memalign.h> > >> > +#include <ubi_uboot.h> > >> > +#include <spi.h> > >> > +#include <spi_flash.h> > >> > +#include <asm/io.h> > >> > +#include <asm/arch/hardware.h> > >> > +#include <asm/arch/sys_proto.h> > >> > +#include <asm/arch/clk.h> > >> > +#include "../mtd/spi/sf_internal.h" > >> > >> This I've already commented and still there any reason? > >> > >> > +#include <clk.h> > >> > +#include <asm/arch/zynqmp_qspi.h> > >> > + > >> > +DECLARE_GLOBAL_DATA_PTR; > >> > + > >> > +struct zynqmp_qspi_platdata { > >> > + struct zynqmp_qspi_regs *regs; > >> > + struct zynqmp_qspi_dma_regs *dma_regs; > >> > + u32 frequency; > >> > + u32 speed_hz; > >> > + unsigned int tx_rx_mode; > >> > +}; > >> > + > >> > +struct zynqmp_qspi_priv { > >> > + struct zynqmp_qspi_regs *regs; > >> > + struct zynqmp_qspi_dma_regs *dma_regs; > >> > + u8 mode; > >> > + const void *tx_buf; > >> > + void *rx_buf; > >> > + unsigned int len; > >> > + int bytes_to_transfer; > >> > + int bytes_to_receive; > >> > + unsigned int is_inst; > >> > + unsigned int cs_change:1; > >> > +}; > >> > + > >> > +static u8 last_cmd; > >> > + > >> > +static int zynqmp_qspi_ofdata_to_platdata(struct udevice *bus) { > >> > + struct zynqmp_qspi_platdata *plat = bus->platdata; > >> > + u32 mode = 0; > >> > + u32 value; > >> > + int ret; > >> > + struct clk clk; > >> > + unsigned long clock; > >> > + > >> > + debug("%s\n", __func__); > >> > >> no need > > > > Any issue in having it with debug..?? I can remove if you don’t like. > >> > >> > + > >> > + plat->regs = (struct zynqmp_qspi_regs *)(devfdt_get_addr(bus) + > >> > + ZYNQMP_GQSPI_REG_OFFSET); > >> > + plat->dma_regs = (struct zynqmp_qspi_dma_regs *) > >> > + (devfdt_get_addr(bus) + > >> > + ZYNQMP_GQSPI_DMA_REG_OFFSET); > >> > + > >> > + ret = clk_get_by_index(bus, 0, &clk); > >> > + if (ret < 0) { > >> > + dev_err(dev, "failed to get clock\n"); > >> > + return ret; > >> > + } > >> > + > >> > + clock = clk_get_rate(&clk); > >> > + if (IS_ERR_VALUE(clock)) { > >> > + dev_err(dev, "failed to get rate\n"); > >> > + return clock; > >> > + } > >> > + debug("%s: CLK %ld\n", __func__, clock); > >> > + > >> > + ret = clk_enable(&clk); > >> > + if (ret && ret != -ENOSYS) { > >> > + dev_err(dev, "failed to enable clock\n"); > >> > + return ret; > >> > + } > >> > + > >> > + value = dev_read_u32_default(bus, "spi-rx-bus-width", 1); > >> > + switch (value) { > >> > + case 1: > >> > + break; > >> > + case 2: > >> > + mode |= SPI_RX_DUAL; > >> > + break; > >> > + case 4: > >> > + mode |= SPI_RX_QUAD; > >> > + break; > >> > + default: > >> > + printf("Invalid spi-rx-bus-width %d\n", value); > >> > + break; > >> > + } > >> > + > >> > + value = dev_read_u32_default(bus, "spi-tx-bus-width", 1); > >> > + switch (value) { > >> > + case 1: > >> > + break; > >> > + case 2: > >> > + mode |= SPI_TX_DUAL; > >> > + break; > >> > + case 4: > >> > + mode |= SPI_TX_QUAD; > >> > + break; > >> > + default: > >> > + printf("Invalid spi-tx-bus-width %d\n", value); > >> > + break; > >> > + } > >> > + > >> > + plat->tx_rx_mode = mode; > >> > + > >> > + plat->frequency = clock; > >> > + plat->speed_hz = plat->frequency; > >> > >> why we need this? all these are generic stuff which is available at > >> spi- uclass.c > > > > Somehow I am not able to get these from spi-uclass.c , the routine which > reads all these info from dt in spi-uclass.c is never getting invoked in my > flow. > > I checked other driver as well,. Do you have an idea on why is it so? > > All these attributes are from platdata which were initialized by spi-uclass.c > so if you need any of these we can get the dm_spi_slave_platdata from > your driver using dev_get_parent_platdata() function. Looks like you didn’t get my point, in my flow the routine spi_slave_ofdata_to_platdata() in spi-uclass.c is not getting invoked at all that’s why I am not getting this data from spi-uclass.c. do you have an idea on what could be the issue that spi_slave_ofdata_to_platdata() is not getting invoked. I will anyway debug it but, if you already encountered this and aware of any reason for this , please let me know, that really helps me. Thanks, Siva > > Remeber let not add spi-nor features in this driver, you may ended-up more > adding more redundent code in driver if you do so. > > Fix, what ever comments you agree and resend we will review again. > > Jagan. > > > -- > Jagan Teki > Senior Linux Kernel Engineer | Amarula Solutions U-Boot, Linux | Upstream > Maintainer Hyderabad, India.
On Wed, May 2, 2018 at 2:49 PM, Siva Durga Prasad Paladugu <sivadur@xilinx.com> wrote: > Hi, > >> -----Original Message----- >> From: Jagan Teki [mailto:jagan@amarulasolutions.com] >> Sent: Wednesday, April 25, 2018 10:47 AM >> To: Siva Durga Prasad Paladugu <sivadur@xilinx.com> >> Cc: U-Boot-Denx <u-boot@lists.denx.de> >> Subject: Re: [U-Boot] [PATCH v2 1/2] spi: zynqmp_qspi: Add support for >> ZynqMP qspi driver [snip] >> >> >> >> > + >> >> > + plat->regs = (struct zynqmp_qspi_regs *)(devfdt_get_addr(bus) + >> >> > + ZYNQMP_GQSPI_REG_OFFSET); >> >> > + plat->dma_regs = (struct zynqmp_qspi_dma_regs *) >> >> > + (devfdt_get_addr(bus) + >> >> > + ZYNQMP_GQSPI_DMA_REG_OFFSET); >> >> > + >> >> > + ret = clk_get_by_index(bus, 0, &clk); >> >> > + if (ret < 0) { >> >> > + dev_err(dev, "failed to get clock\n"); >> >> > + return ret; >> >> > + } >> >> > + >> >> > + clock = clk_get_rate(&clk); >> >> > + if (IS_ERR_VALUE(clock)) { >> >> > + dev_err(dev, "failed to get rate\n"); >> >> > + return clock; >> >> > + } >> >> > + debug("%s: CLK %ld\n", __func__, clock); >> >> > + >> >> > + ret = clk_enable(&clk); >> >> > + if (ret && ret != -ENOSYS) { >> >> > + dev_err(dev, "failed to enable clock\n"); >> >> > + return ret; >> >> > + } >> >> > + >> >> > + value = dev_read_u32_default(bus, "spi-rx-bus-width", 1); >> >> > + switch (value) { >> >> > + case 1: >> >> > + break; >> >> > + case 2: >> >> > + mode |= SPI_RX_DUAL; >> >> > + break; >> >> > + case 4: >> >> > + mode |= SPI_RX_QUAD; >> >> > + break; >> >> > + default: >> >> > + printf("Invalid spi-rx-bus-width %d\n", value); >> >> > + break; >> >> > + } >> >> > + >> >> > + value = dev_read_u32_default(bus, "spi-tx-bus-width", 1); >> >> > + switch (value) { >> >> > + case 1: >> >> > + break; >> >> > + case 2: >> >> > + mode |= SPI_TX_DUAL; >> >> > + break; >> >> > + case 4: >> >> > + mode |= SPI_TX_QUAD; >> >> > + break; >> >> > + default: >> >> > + printf("Invalid spi-tx-bus-width %d\n", value); >> >> > + break; >> >> > + } >> >> > + >> >> > + plat->tx_rx_mode = mode; >> >> > + >> >> > + plat->frequency = clock; >> >> > + plat->speed_hz = plat->frequency; >> >> >> >> why we need this? all these are generic stuff which is available at >> >> spi- uclass.c >> > >> > Somehow I am not able to get these from spi-uclass.c , the routine which >> reads all these info from dt in spi-uclass.c is never getting invoked in my >> flow. >> > I checked other driver as well,. Do you have an idea on why is it so? >> >> All these attributes are from platdata which were initialized by spi-uclass.c >> so if you need any of these we can get the dm_spi_slave_platdata from >> your driver using dev_get_parent_platdata() function. > > Looks like you didn’t get my point, in my flow the routine spi_slave_ofdata_to_platdata() in spi-uclass.c is > not getting invoked at all that’s why I am not getting this data from spi-uclass.c. do you have an idea on > what could be the issue that spi_slave_ofdata_to_platdata() is not getting invoked. > I will anyway debug it but, if you already encountered this and aware of any reason for this , please let me know, that really helps me. Fix the rest and keep this as it is we will discuss on next version. Jagan.
diff --git a/arch/arm/cpu/armv8/zynqmp/Kconfig b/arch/arm/cpu/armv8/zynqmp/Kconfig index 3f922b4..2fe4f71 100644 --- a/arch/arm/cpu/armv8/zynqmp/Kconfig +++ b/arch/arm/cpu/armv8/zynqmp/Kconfig @@ -65,6 +65,13 @@ config PMUFW_INIT_FILE Include external PMUFW (Platform Management Unit FirmWare) to a Xilinx bootable image (boot.bin). +config ZYNQMP_QSPI + bool "Configure ZynqMP QSPI" + select DM_SPI + help + This option is used to enable ZynqMP QSPI controller driver which + is used to communicate with qspi flash devices. + config ZYNQMP_USB bool "Configure ZynqMP USB" diff --git a/arch/arm/include/asm/arch-zynqmp/zynqmp_qspi.h b/arch/arm/include/asm/arch-zynqmp/zynqmp_qspi.h new file mode 100644 index 0000000..5e2926e --- /dev/null +++ b/arch/arm/include/asm/arch-zynqmp/zynqmp_qspi.h @@ -0,0 +1,154 @@ +/* + * (C) Copyright 2014 - 2015 Xilinx + * + * Xilinx ZynqMP Quad-SPI(QSPI) controller driver (master mode only) + * + * SPDX-License-Identifier: GPL-2.0+ + */ + +#ifndef _ASM_ARCH_ZYNQMP_QSPI_H_ +#define _ASM_ARCH_ZYNQMP_QSPI_H_ + +#define ZYNQMP_QSPI_GFIFO_STRT_MODE_MASK BIT(29) +#define ZYNQMP_QSPI_CONFIG_MODE_EN_MASK (3 << 30) +#define ZYNQMP_QSPI_CONFIG_DMA_MODE (2 << 30) +#define ZYNQMP_QSPI_CONFIG_CPHA_MASK BIT(2) +#define ZYNQMP_QSPI_CONFIG_CPOL_MASK BIT(1) + +/* QSPI MIO's count for different connection topologies */ +#define ZYNQMP_QSPI_MIO_NUM_QSPI0 6 +#define ZYNQMP_QSPI_MIO_NUM_QSPI1 5 +#define ZYNQMP_QSPI_MIO_NUM_QSPI1_CS 1 + +/* + * QSPI Interrupt Registers bit Masks + * + * All the four interrupt registers (Status/Mask/Enable/Disable) have the same + * bit definitions. + */ +#define ZYNQMP_QSPI_IXR_TXNFULL_MASK 0x00000004 /* QSPI TX FIFO Overflow */ +#define ZYNQMP_QSPI_IXR_TXFULL_MASK 0x00000008 /* QSPI TX FIFO is full */ +#define ZYNQMP_QSPI_IXR_RXNEMTY_MASK 0x00000010 /* QSPI RX FIFO Not Empty */ +#define ZYNQMP_QSPI_IXR_GFEMTY_MASK 0x00000080 /* QSPI Generic FIFO Empty */ +#define ZYNQMP_QSPI_IXR_ALL_MASK (ZYNQMP_QSPI_IXR_TXNFULL_MASK | \ + ZYNQMP_QSPI_IXR_RXNEMTY_MASK) + +/* + * QSPI Enable Register bit Masks + * + * This register is used to enable or disable the QSPI controller + */ +#define ZYNQMP_QSPI_ENABLE_ENABLE_MASK 0x00000001 /* QSPI Enable Bit Mask */ + +#define ZYNQMP_QSPI_GFIFO_LOW_BUS BIT(14) +#define ZYNQMP_QSPI_GFIFO_CS_LOWER BIT(12) +#define ZYNQMP_QSPI_GFIFO_UP_BUS BIT(15) +#define ZYNQMP_QSPI_GFIFO_CS_UPPER BIT(13) +#define ZYNQMP_QSPI_SPI_MODE_QSPI (3 << 10) +#define ZYNQMP_QSPI_SPI_MODE_SPI BIT(10) +#define ZYNQMP_QSPI_SPI_MODE_DUAL_SPI (2 << 10) +#define ZYNQMP_QSPI_IMD_DATA_CS_ASSERT 5 +#define ZYNQMP_QSPI_IMD_DATA_CS_DEASSERT 5 +#define ZYNQMP_QSPI_GFIFO_TX BIT(16) +#define ZYNQMP_QSPI_GFIFO_RX BIT(17) +#define ZYNQMP_QSPI_GFIFO_STRIPE_MASK BIT(18) +#define ZYNQMP_QSPI_GFIFO_IMD_MASK 0xFF +#define ZYNQMP_QSPI_GFIFO_EXP_MASK BIT(9) +#define ZYNQMP_QSPI_GFIFO_DATA_XFR_MASK BIT(8) +#define ZYNQMP_QSPI_STRT_GEN_FIFO BIT(28) +#define ZYNQMP_QSPI_GEN_FIFO_STRT_MOD BIT(29) +#define ZYNQMP_QSPI_GFIFO_WP_HOLD BIT(19) +#define ZYNQMP_QSPI_BAUD_DIV_MASK (7 << 3) +#define ZYNQMP_QSPI_DFLT_BAUD_RATE_DIV BIT(3) +#define ZYNQMP_QSPI_GFIFO_ALL_INT_MASK 0xFBE +#define ZYNQMP_QSPI_DMA_DST_I_STS_DONE BIT(1) +#define ZYNQMP_QSPI_DMA_DST_I_STS_MASK 0xFE +#define MODEBITS 0x6 + +#define QUAD_OUT_READ_CMD 0x6B +#define QUAD_PAGE_PROGRAM_CMD 0x32 +#define DUAL_OUTPUT_FASTRD_CMD 0x3B + +#define ZYNQMP_QSPI_GFIFO_SELECT BIT(0) + +#define ZYNQMP_QSPI_FIFO_THRESHOLD 1 + +#define SPI_XFER_ON_BOTH 0 +#define SPI_XFER_ON_LOWER 1 +#define SPI_XFER_ON_UPPER 2 + +#define ZYNQMP_QSPI_DMA_ALIGN 0x4 +#define ZYNQMP_QSPI_MAX_BAUD_RATE_VAL 7 +#define ZYNQMP_QSPI_DFLT_BAUD_RATE_VAL 2 + +#define ZYNQMP_QSPI_TIMEOUT 100000000 + +#define GQSPI_BAUD_DIV_SHIFT 2 +#define GQSPI_LPBK_DLY_ADJ_LPBK_SHIFT 5 +#define GQSPI_LPBK_DLY_ADJ_DLY_1 0x2 +#define GQSPI_LPBK_DLY_ADJ_DLY_1_SHIFT 3 +#define GQSPI_LPBK_DLY_ADJ_DLY_0 0x3 +#define GQSPI_USE_DATA_DLY 0x1 +#define GQSPI_USE_DATA_DLY_SHIFT 31 +#define GQSPI_DATA_DLY_ADJ_VALUE 0x2 +#define GQSPI_DATA_DLY_ADJ_SHIFT 28 +#define TAP_DLY_BYPASS_LQSPI_RX_VALUE 0x1 +#define TAP_DLY_BYPASS_LQSPI_RX_SHIFT 2 +#define GQSPI_DATA_DLY_ADJ_OFST 0x000001F8 +#define IOU_TAPDLY_BYPASS_OFST 0xFF180390 +#define GQSPI_LPBK_DLY_ADJ_USE_LPBK_MASK 0x00000020 +#define GQSPI_FREQ_40MHZ 40000000 +#define GQSPI_FREQ_100MHZ 100000000 +#define GQSPI_FREQ_150MHZ 150000000 +#define IOU_TAPDLY_BYPASS_MASK 0x7 + +#define ZYNQMP_GQSPI_REG_OFFSET 0x100 +#define ZYNQMP_GQSPI_DMA_REG_OFFSET 0x800 + +/* QSPI register offsets */ +struct zynqmp_qspi_regs { + u32 confr; /* 0x00 */ + u32 isr; /* 0x04 */ + u32 ier; /* 0x08 */ + u32 idisr; /* 0x0C */ + u32 imaskr; /* 0x10 */ + u32 enbr; /* 0x14 */ + u32 dr; /* 0x18 */ + u32 txd0r; /* 0x1C */ + u32 drxr; /* 0x20 */ + u32 sicr; /* 0x24 */ + u32 txftr; /* 0x28 */ + u32 rxftr; /* 0x2C */ + u32 gpior; /* 0x30 */ + u32 reserved0; /* 0x34 */ + u32 lpbkdly; /* 0x38 */ + u32 reserved1; /* 0x3C */ + u32 genfifo; /* 0x40 */ + u32 gqspisel; /* 0x44 */ + u32 reserved2; /* 0x48 */ + u32 gqfifoctrl; /* 0x4C */ + u32 gqfthr; /* 0x50 */ + u32 gqpollcfg; /* 0x54 */ + u32 gqpollto; /* 0x58 */ + u32 gqxfersts; /* 0x5C */ + u32 gqfifosnap; /* 0x60 */ + u32 gqrxcpy; /* 0x64 */ + u32 reserved3[36]; /* 0x68 */ + u32 gqspidlyadj; /* 0xF8 */ +}; + +struct zynqmp_qspi_dma_regs { + u32 dmadst; /* 0x00 */ + u32 dmasize; /* 0x04 */ + u32 dmasts; /* 0x08 */ + u32 dmactrl; /* 0x0C */ + u32 reserved0; /* 0x10 */ + u32 dmaisr; /* 0x14 */ + u32 dmaier; /* 0x18 */ + u32 dmaidr; /* 0x1C */ + u32 dmaimr; /* 0x20 */ + u32 dmactrl2; /* 0x24 */ + u32 dmadstmsb; /* 0x28 */ +}; + +#endif /* _ASM_ARCH_ZYNQMP_QSPI_H_ */ diff --git a/drivers/spi/Makefile b/drivers/spi/Makefile index e3184db..9cdd94a 100644 --- a/drivers/spi/Makefile +++ b/drivers/spi/Makefile @@ -50,3 +50,4 @@ obj-$(CONFIG_TI_QSPI) += ti_qspi.o obj-$(CONFIG_XILINX_SPI) += xilinx_spi.o obj-$(CONFIG_ZYNQ_SPI) += zynq_spi.o obj-$(CONFIG_ZYNQ_QSPI) += zynq_qspi.o +obj-$(CONFIG_ZYNQMP_QSPI) += zynqmp_qspi.o diff --git a/drivers/spi/zynqmp_qspi.c b/drivers/spi/zynqmp_qspi.c new file mode 100644 index 0000000..199e704 --- /dev/null +++ b/drivers/spi/zynqmp_qspi.c @@ -0,0 +1,678 @@ +/* + * (C) Copyright 2014 - 2015 Xilinx + * + * Xilinx ZynqMP Quad-SPI(QSPI) controller driver (master mode only) + * + * SPDX-License-Identifier: GPL-2.0 + */ + +#include <common.h> +#include <malloc.h> +#include <memalign.h> +#include <ubi_uboot.h> +#include <spi.h> +#include <spi_flash.h> +#include <asm/io.h> +#include <asm/arch/hardware.h> +#include <asm/arch/sys_proto.h> +#include <asm/arch/clk.h> +#include "../mtd/spi/sf_internal.h" +#include <clk.h> +#include <asm/arch/zynqmp_qspi.h> + +DECLARE_GLOBAL_DATA_PTR; + +struct zynqmp_qspi_platdata { + struct zynqmp_qspi_regs *regs; + struct zynqmp_qspi_dma_regs *dma_regs; + u32 frequency; + u32 speed_hz; + unsigned int tx_rx_mode; +}; + +struct zynqmp_qspi_priv { + struct zynqmp_qspi_regs *regs; + struct zynqmp_qspi_dma_regs *dma_regs; + u8 mode; + const void *tx_buf; + void *rx_buf; + unsigned int len; + int bytes_to_transfer; + int bytes_to_receive; + unsigned int is_inst; + unsigned int cs_change:1; +}; + +static u8 last_cmd; + +static int zynqmp_qspi_ofdata_to_platdata(struct udevice *bus) +{ + struct zynqmp_qspi_platdata *plat = bus->platdata; + u32 mode = 0; + u32 value; + int ret; + struct clk clk; + unsigned long clock; + + debug("%s\n", __func__); + + plat->regs = (struct zynqmp_qspi_regs *)(devfdt_get_addr(bus) + + ZYNQMP_GQSPI_REG_OFFSET); + plat->dma_regs = (struct zynqmp_qspi_dma_regs *) + (devfdt_get_addr(bus) + ZYNQMP_GQSPI_DMA_REG_OFFSET); + + ret = clk_get_by_index(bus, 0, &clk); + if (ret < 0) { + dev_err(dev, "failed to get clock\n"); + return ret; + } + + clock = clk_get_rate(&clk); + if (IS_ERR_VALUE(clock)) { + dev_err(dev, "failed to get rate\n"); + return clock; + } + debug("%s: CLK %ld\n", __func__, clock); + + ret = clk_enable(&clk); + if (ret && ret != -ENOSYS) { + dev_err(dev, "failed to enable clock\n"); + return ret; + } + + value = dev_read_u32_default(bus, "spi-rx-bus-width", 1); + switch (value) { + case 1: + break; + case 2: + mode |= SPI_RX_DUAL; + break; + case 4: + mode |= SPI_RX_QUAD; + break; + default: + printf("Invalid spi-rx-bus-width %d\n", value); + break; + } + + value = dev_read_u32_default(bus, "spi-tx-bus-width", 1); + switch (value) { + case 1: + break; + case 2: + mode |= SPI_TX_DUAL; + break; + case 4: + mode |= SPI_TX_QUAD; + break; + default: + printf("Invalid spi-tx-bus-width %d\n", value); + break; + } + + plat->tx_rx_mode = mode; + + plat->frequency = clock; + plat->speed_hz = plat->frequency; + + return 0; +} + +static void zynqmp_qspi_init_hw(struct zynqmp_qspi_priv *priv) +{ + u32 config_reg; + struct zynqmp_qspi_regs *regs = priv->regs; + + writel(ZYNQMP_QSPI_GFIFO_SELECT, ®s->gqspisel); + writel(ZYNQMP_QSPI_GFIFO_ALL_INT_MASK, ®s->idisr); + writel(ZYNQMP_QSPI_FIFO_THRESHOLD, ®s->txftr); + writel(ZYNQMP_QSPI_FIFO_THRESHOLD, ®s->rxftr); + writel(ZYNQMP_QSPI_GFIFO_ALL_INT_MASK, ®s->isr); + + config_reg = readl(®s->confr); + config_reg &= ~(ZYNQMP_QSPI_GFIFO_STRT_MODE_MASK | + ZYNQMP_QSPI_CONFIG_MODE_EN_MASK); + config_reg |= ZYNQMP_QSPI_CONFIG_DMA_MODE | + ZYNQMP_QSPI_GFIFO_WP_HOLD | + ZYNQMP_QSPI_DFLT_BAUD_RATE_DIV; + writel(config_reg, ®s->confr); + + writel(ZYNQMP_QSPI_ENABLE_ENABLE_MASK, ®s->enbr); +} + +static u32 zynqmp_qspi_bus_select(struct zynqmp_qspi_priv *priv) +{ + u32 gqspi_fifo_reg = 0; + + gqspi_fifo_reg = ZYNQMP_QSPI_GFIFO_LOW_BUS | + ZYNQMP_QSPI_GFIFO_CS_LOWER; + + return gqspi_fifo_reg; +} + +static void zynqmp_qspi_fill_gen_fifo(struct zynqmp_qspi_priv *priv, + u32 gqspi_fifo_reg) +{ + struct zynqmp_qspi_regs *regs = priv->regs; + u32 reg; + + do { + reg = readl(®s->isr); + } while (!(reg & ZYNQMP_QSPI_IXR_GFEMTY_MASK)); + + writel(gqspi_fifo_reg, ®s->genfifo); +} + +static void zynqmp_qspi_chipselect(struct zynqmp_qspi_priv *priv, int is_on) +{ + u32 gqspi_fifo_reg = 0; + + if (is_on) { + gqspi_fifo_reg = zynqmp_qspi_bus_select(priv); + gqspi_fifo_reg |= ZYNQMP_QSPI_SPI_MODE_SPI | + ZYNQMP_QSPI_IMD_DATA_CS_ASSERT; + } else { + gqspi_fifo_reg = ZYNQMP_QSPI_GFIFO_LOW_BUS; + gqspi_fifo_reg |= ZYNQMP_QSPI_IMD_DATA_CS_DEASSERT; + } + + debug("GFIFO_CMD_CS: 0x%x\n", gqspi_fifo_reg); + + zynqmp_qspi_fill_gen_fifo(priv, gqspi_fifo_reg); +} + +void zynqmp_qspi_set_tapdelay(struct udevice *bus, u32 baudrateval) +{ + struct zynqmp_qspi_platdata *plat = bus->platdata; + struct zynqmp_qspi_priv *priv = dev_get_priv(bus); + struct zynqmp_qspi_regs *regs = priv->regs; + u32 tapdlybypass = 0, lpbkdlyadj = 0, datadlyadj = 0, clk_rate; + u32 reqhz = 0; + + clk_rate = plat->frequency; + reqhz = (clk_rate / (GQSPI_BAUD_DIV_SHIFT << baudrateval)); + + debug("%s, req_hz:%d, clk_rate:%d, baudrateval:%d\n", + __func__, reqhz, clk_rate, baudrateval); + + if (reqhz < GQSPI_FREQ_40MHZ) { + zynqmp_mmio_read(IOU_TAPDLY_BYPASS_OFST, &tapdlybypass); + tapdlybypass |= (TAP_DLY_BYPASS_LQSPI_RX_VALUE << + TAP_DLY_BYPASS_LQSPI_RX_SHIFT); + } else if (reqhz < GQSPI_FREQ_100MHZ) { + zynqmp_mmio_read(IOU_TAPDLY_BYPASS_OFST, &tapdlybypass); + tapdlybypass |= (TAP_DLY_BYPASS_LQSPI_RX_VALUE << + TAP_DLY_BYPASS_LQSPI_RX_SHIFT); + lpbkdlyadj = readl(®s->lpbkdly); + lpbkdlyadj |= (GQSPI_LPBK_DLY_ADJ_USE_LPBK_MASK); + datadlyadj = readl(®s->gqspidlyadj); + datadlyadj |= ((GQSPI_USE_DATA_DLY << GQSPI_USE_DATA_DLY_SHIFT) + | (GQSPI_DATA_DLY_ADJ_VALUE << + GQSPI_DATA_DLY_ADJ_SHIFT)); + } else if (reqhz < GQSPI_FREQ_150MHZ) { + lpbkdlyadj = readl(®s->lpbkdly); + lpbkdlyadj |= ((GQSPI_LPBK_DLY_ADJ_USE_LPBK_MASK) | + GQSPI_LPBK_DLY_ADJ_DLY_0); + } + + zynqmp_mmio_write(IOU_TAPDLY_BYPASS_OFST, IOU_TAPDLY_BYPASS_MASK, + tapdlybypass); + writel(lpbkdlyadj, ®s->lpbkdly); + writel(datadlyadj, ®s->gqspidlyadj); +} + +static int zynqmp_qspi_set_speed(struct udevice *bus, uint speed) +{ + struct zynqmp_qspi_platdata *plat = bus->platdata; + struct zynqmp_qspi_priv *priv = dev_get_priv(bus); + struct zynqmp_qspi_regs *regs = priv->regs; + u32 confr; + u8 baud_rate_val = 0; + + debug("%s\n", __func__); + if (speed > plat->frequency) + speed = plat->frequency; + + /* Set the clock frequency */ + confr = readl(®s->confr); + if (speed == 0) { + /* Set baudrate x8, if the freq is 0 */ + baud_rate_val = ZYNQMP_QSPI_DFLT_BAUD_RATE_VAL; + } else if (plat->speed_hz != speed) { + while ((baud_rate_val < 8) && + ((plat->frequency / + (2 << baud_rate_val)) > speed)) + baud_rate_val++; + + if (baud_rate_val > ZYNQMP_QSPI_MAX_BAUD_RATE_VAL) + baud_rate_val = ZYNQMP_QSPI_DFLT_BAUD_RATE_VAL; + + plat->speed_hz = plat->frequency / (2 << baud_rate_val); + } + confr &= ~ZYNQMP_QSPI_BAUD_DIV_MASK; + confr |= (baud_rate_val << 3); + writel(confr, ®s->confr); + + zynqmp_qspi_set_tapdelay(bus, baud_rate_val); + debug("regs=%p, speed=%d\n", priv->regs, plat->speed_hz); + + return 0; +} + +static int zynqmp_qspi_child_pre_probe(struct udevice *bus) +{ + struct spi_slave *slave = dev_get_parent_priv(bus); + struct zynqmp_qspi_platdata *plat = dev_get_platdata(bus->parent); + + slave->mode = plat->tx_rx_mode; + + return 0; +} + +static int zynqmp_qspi_probe(struct udevice *bus) +{ + struct zynqmp_qspi_platdata *plat = dev_get_platdata(bus); + struct zynqmp_qspi_priv *priv = dev_get_priv(bus); + + debug("%s: bus:%p, priv:%p\n", __func__, bus, priv); + + priv->regs = plat->regs; + priv->dma_regs = plat->dma_regs; + + /* init the zynq spi hw */ + zynqmp_qspi_init_hw(priv); + + return 0; +} + +static int zynqmp_qspi_set_mode(struct udevice *bus, uint mode) +{ + struct zynqmp_qspi_priv *priv = dev_get_priv(bus); + struct zynqmp_qspi_regs *regs = priv->regs; + u32 confr; + + debug("%s\n", __func__); + /* Set the SPI Clock phase and polarities */ + confr = readl(®s->confr); + confr &= ~(ZYNQMP_QSPI_CONFIG_CPHA_MASK | + ZYNQMP_QSPI_CONFIG_CPOL_MASK); + + if (priv->mode & SPI_CPHA) + confr |= ZYNQMP_QSPI_CONFIG_CPHA_MASK; + if (priv->mode & SPI_CPOL) + confr |= ZYNQMP_QSPI_CONFIG_CPOL_MASK; + + priv->mode = mode; + + debug("regs=%p, mode=%d\n", priv->regs, priv->mode); + + return 0; +} + +static int zynqmp_qspi_fill_tx_fifo(struct zynqmp_qspi_priv *priv, u32 size) +{ + u32 data; + u32 timeout = ZYNQMP_QSPI_TIMEOUT; + struct zynqmp_qspi_regs *regs = priv->regs; + u32 *buf = (u32 *)priv->tx_buf; + u32 len = size; + + debug("TxFIFO: 0x%x, size: 0x%x\n", readl(®s->isr), + size); + + while (size && timeout) { + if (readl(®s->isr) & + ZYNQMP_QSPI_IXR_TXNFULL_MASK) { + if (size >= 4) { + writel(*buf, ®s->txd0r); + buf++; + size -= 4; + } else { + switch (size) { + case 1: + data = *((u8 *)buf); + buf += 1; + data |= 0xFFFFFF00; + break; + case 2: + data = *((u16 *)buf); + buf += 2; + data |= 0xFFFF0000; + break; + case 3: + data = *((u16 *)buf); + buf += 2; + data |= (*((u8 *)buf) << 16); + buf += 1; + data |= 0xFF000000; + break; + } + writel(data, ®s->txd0r); + size = 0; + } + } else { + udelay(1); + timeout--; + } + } + if (!timeout) { + printf("%s: Timeout\n", __func__); + return -1; + } + + priv->tx_buf += len; + return 0; +} + +static void zynqmp_qspi_genfifo_cmd(struct zynqmp_qspi_priv *priv) +{ + u8 command = 1; + u32 gen_fifo_cmd; + u32 bytecount = 0; + + while (priv->len) { + gen_fifo_cmd = zynqmp_qspi_bus_select(priv); + gen_fifo_cmd |= ZYNQMP_QSPI_GFIFO_TX; + + if (command) { + command = 0; + last_cmd = *(u8 *)priv->tx_buf; + } + + gen_fifo_cmd |= ZYNQMP_QSPI_SPI_MODE_SPI; + gen_fifo_cmd |= *(u8 *)priv->tx_buf; + bytecount++; + priv->len--; + priv->tx_buf = (u8 *)priv->tx_buf + 1; + + debug("GFIFO_CMD_Cmd = 0x%x\n", gen_fifo_cmd); + + zynqmp_qspi_fill_gen_fifo(priv, gen_fifo_cmd); + } +} + +static u32 zynqmp_qspi_calc_exp(struct zynqmp_qspi_priv *priv, + u32 *gen_fifo_cmd) +{ + u32 expval = 8; + u32 len; + + while (1) { + if (priv->len > 255) { + if (priv->len & (1 << expval)) { + *gen_fifo_cmd &= ~ZYNQMP_QSPI_GFIFO_IMD_MASK; + *gen_fifo_cmd |= ZYNQMP_QSPI_GFIFO_EXP_MASK; + *gen_fifo_cmd |= expval; + priv->len -= (1 << expval); + return expval; + } + expval++; + } else { + *gen_fifo_cmd &= ~(ZYNQMP_QSPI_GFIFO_IMD_MASK | + ZYNQMP_QSPI_GFIFO_EXP_MASK); + *gen_fifo_cmd |= (u8)priv->len; + len = (u8)priv->len; + priv->len = 0; + return len; + } + } +} + +static int zynqmp_qspi_genfifo_fill_tx(struct zynqmp_qspi_priv *priv) +{ + u32 gen_fifo_cmd; + u32 len; + int ret = 0; + + gen_fifo_cmd = zynqmp_qspi_bus_select(priv); + gen_fifo_cmd |= ZYNQMP_QSPI_GFIFO_TX | + ZYNQMP_QSPI_GFIFO_DATA_XFR_MASK; + + if (last_cmd == QUAD_PAGE_PROGRAM_CMD) + gen_fifo_cmd |= ZYNQMP_QSPI_SPI_MODE_QSPI; + else + gen_fifo_cmd |= ZYNQMP_QSPI_SPI_MODE_SPI; + + while (priv->len) { + len = zynqmp_qspi_calc_exp(priv, &gen_fifo_cmd); + zynqmp_qspi_fill_gen_fifo(priv, gen_fifo_cmd); + + debug("GFIFO_CMD_TX:0x%x\n", gen_fifo_cmd); + + if (gen_fifo_cmd & ZYNQMP_QSPI_GFIFO_EXP_MASK) + ret = zynqmp_qspi_fill_tx_fifo(priv, + 1 << len); + else + ret = zynqmp_qspi_fill_tx_fifo(priv, + len); + + if (ret) + return ret; + } + return ret; +} + +static int zynqmp_qspi_start_dma(struct zynqmp_qspi_priv *priv, + u32 gen_fifo_cmd, u32 *buf) +{ + u32 addr; + u32 size, len; + u32 timeout = ZYNQMP_QSPI_TIMEOUT; + u32 actuallen = priv->len; + struct zynqmp_qspi_dma_regs *dma_regs = priv->dma_regs; + + writel((unsigned long)buf, &dma_regs->dmadst); + writel(roundup(priv->len, 4), &dma_regs->dmasize); + writel(ZYNQMP_QSPI_DMA_DST_I_STS_MASK, &dma_regs->dmaier); + addr = (unsigned long)buf; + size = roundup(priv->len, ARCH_DMA_MINALIGN); + flush_dcache_range(addr, addr + size); + + while (priv->len) { + len = zynqmp_qspi_calc_exp(priv, &gen_fifo_cmd); + if (!(gen_fifo_cmd & ZYNQMP_QSPI_GFIFO_EXP_MASK) && + (len % 4)) { + gen_fifo_cmd &= ~(0xFF); + gen_fifo_cmd |= (len / 4 + 1) * 4; + } + zynqmp_qspi_fill_gen_fifo(priv, gen_fifo_cmd); + + debug("GFIFO_CMD_RX:0x%x\n", gen_fifo_cmd); + } + + while (timeout) { + if (readl(&dma_regs->dmaisr) & + ZYNQMP_QSPI_DMA_DST_I_STS_DONE) { + writel(ZYNQMP_QSPI_DMA_DST_I_STS_DONE, + &dma_regs->dmaisr); + break; + } + udelay(1); + timeout--; + } + + debug("buf:0x%lx, rxbuf:0x%lx, *buf:0x%x len: 0x%x\n", + (unsigned long)buf, (unsigned long)priv->rx_buf, *buf, + actuallen); + if (!timeout) { + printf("DMA Timeout:0x%x\n", readl(&dma_regs->dmaisr)); + return -1; + } + + if (buf != priv->rx_buf) + memcpy(priv->rx_buf, buf, actuallen); + + return 0; +} + +static int zynqmp_qspi_genfifo_fill_rx(struct zynqmp_qspi_priv *priv) +{ + u32 gen_fifo_cmd; + u32 *buf; + u32 actuallen = priv->len; + + gen_fifo_cmd = zynqmp_qspi_bus_select(priv); + gen_fifo_cmd |= ZYNQMP_QSPI_GFIFO_RX | + ZYNQMP_QSPI_GFIFO_DATA_XFR_MASK; + + if (last_cmd == QUAD_OUT_READ_CMD) + gen_fifo_cmd |= ZYNQMP_QSPI_SPI_MODE_QSPI; + else if (last_cmd == DUAL_OUTPUT_FASTRD_CMD) + gen_fifo_cmd |= ZYNQMP_QSPI_SPI_MODE_DUAL_SPI; + else + gen_fifo_cmd |= ZYNQMP_QSPI_SPI_MODE_SPI; + + /* + * Check if receive buffer is aligned to 4 byte and length + * is multiples of four byte as we are using dma to receive. + */ + if (!((unsigned long)priv->rx_buf & (ZYNQMP_QSPI_DMA_ALIGN - 1)) && + !(actuallen % ZYNQMP_QSPI_DMA_ALIGN)) { + buf = (u32 *)priv->rx_buf; + return zynqmp_qspi_start_dma(priv, gen_fifo_cmd, buf); + } + + ALLOC_CACHE_ALIGN_BUFFER(u8, tmp, roundup(priv->len, + ZYNQMP_QSPI_DMA_ALIGN)); + buf = (u32 *)tmp; + return zynqmp_qspi_start_dma(priv, gen_fifo_cmd, buf); +} + +static int zynqmp_qspi_start_transfer(struct zynqmp_qspi_priv *priv) +{ + int ret = 0; + + if (priv->is_inst) { + if (priv->tx_buf) + zynqmp_qspi_genfifo_cmd(priv); + else + ret = -1; + } else { + if (priv->tx_buf) + ret = zynqmp_qspi_genfifo_fill_tx(priv); + else if (priv->rx_buf) + ret = zynqmp_qspi_genfifo_fill_rx(priv); + else + ret = -1; + } + return ret; +} + +static int zynqmp_qspi_transfer(struct zynqmp_qspi_priv *priv) +{ + static unsigned int cs_change = 1; + int status = 0; + + debug("%s\n", __func__); + + while (1) { + /* Select the chip if required */ + if (cs_change) + zynqmp_qspi_chipselect(priv, 1); + + cs_change = priv->cs_change; + + if (!priv->tx_buf && !priv->rx_buf && priv->len) { + status = -1; + break; + } + + /* Request the transfer */ + if (priv->len) { + status = zynqmp_qspi_start_transfer(priv); + priv->is_inst = 0; + if (status < 0) + break; + } + + if (cs_change) + /* Deselect the chip */ + zynqmp_qspi_chipselect(priv, 0); + break; + } + + return status; +} + +static int zynqmp_qspi_claim_bus(struct udevice *dev) +{ + struct udevice *bus = dev->parent; + struct zynqmp_qspi_priv *priv = dev_get_priv(bus); + struct zynqmp_qspi_regs *regs = priv->regs; + + debug("%s\n", __func__); + writel(ZYNQMP_QSPI_ENABLE_ENABLE_MASK, ®s->enbr); + + return 0; +} + +static int zynqmp_qspi_release_bus(struct udevice *dev) +{ + struct udevice *bus = dev->parent; + struct zynqmp_qspi_priv *priv = dev_get_priv(bus); + struct zynqmp_qspi_regs *regs = priv->regs; + + debug("%s\n", __func__); + writel(~ZYNQMP_QSPI_ENABLE_ENABLE_MASK, ®s->enbr); + + return 0; +} + +int zynqmp_qspi_xfer(struct udevice *dev, unsigned int bitlen, const void *dout, + void *din, unsigned long flags) +{ + struct udevice *bus = dev->parent; + struct zynqmp_qspi_priv *priv = dev_get_priv(bus); + + debug("%s: priv: 0x%08lx bitlen: %d dout: 0x%08lx ", __func__, + (unsigned long)priv, bitlen, (unsigned long)dout); + debug("din: 0x%08lx flags: 0x%lx\n", (unsigned long)din, flags); + + priv->tx_buf = dout; + priv->rx_buf = din; + priv->len = bitlen / 8; + + /* + * Festering sore. + * Assume that the beginning of a transfer with bits to + * transmit must contain a device command. + */ + if (dout && flags & SPI_XFER_BEGIN) + priv->is_inst = 1; + else + priv->is_inst = 0; + + if (flags & SPI_XFER_END) + priv->cs_change = 1; + else + priv->cs_change = 0; + + zynqmp_qspi_transfer(priv); + + return 0; +} + +static const struct dm_spi_ops zynqmp_qspi_ops = { + .claim_bus = zynqmp_qspi_claim_bus, + .release_bus = zynqmp_qspi_release_bus, + .xfer = zynqmp_qspi_xfer, + .set_speed = zynqmp_qspi_set_speed, + .set_mode = zynqmp_qspi_set_mode, +}; + +static const struct udevice_id zynqmp_qspi_ids[] = { + { .compatible = "xlnx,zynqmp-qspi-1.0" }, + { } +}; + +U_BOOT_DRIVER(zynqmp_qspi) = { + .name = "zynqmp_qspi", + .id = UCLASS_SPI, + .of_match = zynqmp_qspi_ids, + .ops = &zynqmp_qspi_ops, + .ofdata_to_platdata = zynqmp_qspi_ofdata_to_platdata, + .platdata_auto_alloc_size = sizeof(struct zynqmp_qspi_platdata), + .priv_auto_alloc_size = sizeof(struct zynqmp_qspi_priv), + .probe = zynqmp_qspi_probe, + .child_pre_probe = zynqmp_qspi_child_pre_probe, +};
This patch adds qspi driver support for ZynqMP SoC. This driver is responsible for communicating with qspi flash devices. Signed-off-by: Siva Durga Prasad Paladugu <sivadur@xilinx.com> --- Changes from v1: - Rebased on top of latest master - Moved macro definitions to .h file as per comment - Fixed magic values with macros as per comment --- arch/arm/cpu/armv8/zynqmp/Kconfig | 7 + arch/arm/include/asm/arch-zynqmp/zynqmp_qspi.h | 154 ++++++ drivers/spi/Makefile | 1 + drivers/spi/zynqmp_qspi.c | 678 +++++++++++++++++++++++++ 4 files changed, 840 insertions(+) create mode 100644 arch/arm/include/asm/arch-zynqmp/zynqmp_qspi.h create mode 100644 drivers/spi/zynqmp_qspi.c