]> git.ipfire.org Git - people/ms/u-boot.git/commitdiff
ARM: SPI: stm32: add stm32f746 qspi driver
authorMichael Kurz <michi.kurz@gmail.com>
Sun, 22 Jan 2017 15:04:30 +0000 (16:04 +0100)
committerTom Rini <trini@konsulko.com>
Sat, 28 Jan 2017 19:04:50 +0000 (14:04 -0500)
This patch adds support for the QSPI IP found in stm32f7 devices.

Signed-off-by: Michael Kurz <michi.kurz@gmail.com>
arch/arm/include/asm/arch-stm32f7/rcc.h
arch/arm/include/asm/arch-stm32f7/stm32_periph.h
arch/arm/mach-stm32/stm32f7/clock.c
board/st/stm32f746-disco/stm32f746-disco.c
configs/stm32f746-disco_defconfig
drivers/spi/Kconfig
drivers/spi/Makefile
drivers/spi/stm32_qspi.c [new file with mode: 0644]

index 23eec5efb68e2431f60c35ca0ae6b1c33f234dfa..0f8d50b4c6140a11a3313bb2cd4f203166ef09c0 100644 (file)
@@ -31,6 +31,7 @@
  * RCC AHB3ENR specific definitions
  */
 #define RCC_AHB3ENR_FMC_EN             BIT(0)
+#define RCC_AHB3ENR_QSPI_EN             BIT(1)
 
 /*
  * RCC APB1ENR specific definitions
index 508b5f27169a640ea520239919f5adcc0f286021..3c5604ae29ad2d4caeab73de4bcf59f59286d480 100644 (file)
@@ -15,8 +15,9 @@
  *
  */
 enum periph_id {
-       UART1_GPIOA_9_10 = 0,
-       UART2_GPIOD_5_6,
+       PERIPH_ID_USART1 = 37,
+
+       PERIPH_ID_QUADSPI = 92,
 };
 
 enum periph_clock {
@@ -37,6 +38,7 @@ enum periph_clock {
        TIMER2_CLOCK_CFG,
        FMC_CLOCK_CFG,
        STMMAC_CLOCK_CFG,
+       QSPI_CLOCK_CFG,
 };
 
 #endif /* __ASM_ARM_ARCH_PERIPH_H */
index 8b3d3fd73abc30c543840c5777a7ff47ffb40adb..e1ee1731f7fe9557ad755a75b1767fc7531b2235 100644 (file)
@@ -266,6 +266,9 @@ void clock_setup(int peripheral)
                setbits_le32(&STM32_RCC->ahb1enr, RCC_AHB1ENR_ETHMAC_RX_EN);
                setbits_le32(&STM32_RCC->ahb1enr, RCC_AHB1ENR_ETHMAC_TX_EN);
                break;
+       case QSPI_CLOCK_CFG:
+               setbits_le32(&STM32_RCC->ahb3enr, RCC_AHB3ENR_QSPI_EN);
+               break;
        default:
                break;
        }
index 6c1613880a65dfb33a4c6aceb80b6de2d68b12c8..7ed7bf7263a1fc1616336fc7297a4d5ea5c9e6b1 100644 (file)
@@ -326,6 +326,60 @@ static int stmmac_setup(void)
 }
 #endif
 
+#ifdef CONFIG_STM32_QSPI
+const struct stm32_gpio_ctl gpio_ctl_qspi_9 = {
+       .mode = STM32_GPIO_MODE_AF,
+       .otype = STM32_GPIO_OTYPE_PP,
+       .speed = STM32_GPIO_SPEED_100M,
+       .pupd = STM32_GPIO_PUPD_NO,
+       .af = STM32_GPIO_AF9
+};
+
+const struct stm32_gpio_ctl gpio_ctl_qspi_10 = {
+       .mode = STM32_GPIO_MODE_AF,
+       .otype = STM32_GPIO_OTYPE_PP,
+       .speed = STM32_GPIO_SPEED_100M,
+       .pupd = STM32_GPIO_PUPD_NO,
+       .af = STM32_GPIO_AF10
+};
+
+static const struct stm32_gpio_dsc qspi_af9_gpio[] = {
+       {STM32_GPIO_PORT_B, STM32_GPIO_PIN_2},  /* QUADSPI_CLK */
+       {STM32_GPIO_PORT_D, STM32_GPIO_PIN_11}, /* QUADSPI_BK1_IO0 */
+       {STM32_GPIO_PORT_D, STM32_GPIO_PIN_12}, /* QUADSPI_BK1_IO1 */
+       {STM32_GPIO_PORT_D, STM32_GPIO_PIN_13}, /* QUADSPI_BK1_IO3 */
+       {STM32_GPIO_PORT_E, STM32_GPIO_PIN_2},  /* QUADSPI_BK1_IO2 */
+};
+
+static const struct stm32_gpio_dsc qspi_af10_gpio[] = {
+       {STM32_GPIO_PORT_B, STM32_GPIO_PIN_6},  /* QUADSPI_BK1_NCS */
+};
+
+static int qspi_setup(void)
+{
+       int res = 0;
+       int i;
+
+       clock_setup(GPIO_B_CLOCK_CFG);
+       clock_setup(GPIO_D_CLOCK_CFG);
+       clock_setup(GPIO_E_CLOCK_CFG);
+
+       for (i = 0; i < ARRAY_SIZE(qspi_af9_gpio); i++) {
+               res = stm32_gpio_config(&qspi_af9_gpio[i], &gpio_ctl_qspi_9);
+               if (res)
+                       return res;
+       }
+
+       for (i = 0; i < ARRAY_SIZE(qspi_af10_gpio); i++) {
+               res = stm32_gpio_config(&qspi_af10_gpio[i], &gpio_ctl_qspi_10);
+               if (res)
+                       return res;
+       }
+
+       return 0;
+}
+#endif
+
 u32 get_board_rev(void)
 {
        return 0;
@@ -346,6 +400,12 @@ int board_early_init_f(void)
                return res;
 #endif
 
+#ifdef CONFIG_STM32_QSPI
+       res = qspi_setup();
+       if (res)
+               return res;
+#endif
+
        return 0;
 }
 
index 38caeca03e746b9b443735f9a024d799183a5e97..51b779aa5779335d15c2cce372dd971410254344 100644 (file)
@@ -14,6 +14,7 @@ CONFIG_AUTOBOOT_KEYED=y
 CONFIG_AUTOBOOT_PROMPT="Hit SPACE in %d seconds to stop autoboot.\n"
 CONFIG_AUTOBOOT_STOP_STR=" "
 # CONFIG_CMD_IMLS is not set
+CONFIG_CMD_SF=y
 # CONFIG_CMD_FPGA is not set
 # CONFIG_CMD_SETEXPR is not set
 CONFIG_CMD_DHCP=y
@@ -26,8 +27,14 @@ CONFIG_CMD_TIMER=y
 CONFIG_OF_CONTROL=y
 CONFIG_NET_RANDOM_ETHADDR=y
 CONFIG_NETCONSOLE=y
+CONFIG_MTD=y
+CONFIG_DM_SPI_FLASH=y
+CONFIG_SPI_FLASH=y
+CONFIG_SPI_FLASH_STMICRO=y
 CONFIG_DM_ETH=y
 CONFIG_ETH_DESIGNWARE=y
 # CONFIG_SPL_SERIAL_PRESENT is not set
+CONFIG_DM_SPI=y
+CONFIG_STM32_QSPI=y
 CONFIG_OF_LIBFDT_OVERLAY=y
 # CONFIG_EFI_LOADER is not set
index 0f51b3a21b87ae08a2a96b622a3e92c5afc04c41..f3f7dbe0897b82d204ad44b23172c5b5377ae7c1 100644 (file)
@@ -124,6 +124,14 @@ config SANDBOX_SPI
                };
          };
 
+config STM32_QSPI
+       bool "STM32F7 QSPI driver"
+       depends on STM32F7
+       help
+         Enable the STM32F7 Quad-SPI (QSPI) driver. This driver can be
+         used to access the SPI NOR flash chips on platforms embedding
+         this ST IP core.
+
 config TEGRA114_SPI
        bool "nVidia Tegra114 SPI driver"
        help
index 896b093765985aaad7bff7af92ea769b46e1eb37..fa9a1d2496c61db9accd91dc01abbb14a43c0c30 100644 (file)
@@ -42,6 +42,7 @@ obj-$(CONFIG_ROCKCHIP_SPI) += rk_spi.o
 obj-$(CONFIG_SANDBOX_SPI) += sandbox_spi.o
 obj-$(CONFIG_SH_SPI) += sh_spi.o
 obj-$(CONFIG_SH_QSPI) += sh_qspi.o
+obj-$(CONFIG_STM32_QSPI) += stm32_qspi.o
 obj-$(CONFIG_TEGRA114_SPI) += tegra114_spi.o
 obj-$(CONFIG_TEGRA20_SFLASH) += tegra20_sflash.o
 obj-$(CONFIG_TEGRA20_SLINK) += tegra20_slink.o
diff --git a/drivers/spi/stm32_qspi.c b/drivers/spi/stm32_qspi.c
new file mode 100644 (file)
index 0000000..123a1f3
--- /dev/null
@@ -0,0 +1,628 @@
+/*
+ * (C) Copyright 2016
+ *
+ * Michael Kurz, <michi.kurz@gmail.com>
+ *
+ * STM32 QSPI driver
+ *
+ * SPDX-License-Identifier:    GPL-2.0+
+ */
+
+#include <common.h>
+#include <malloc.h>
+#include <spi.h>
+#include <spi_flash.h>
+#include <asm/io.h>
+#include <dm.h>
+#include <errno.h>
+#include <asm/arch/stm32.h>
+#include <asm/arch/stm32_defs.h>
+
+DECLARE_GLOBAL_DATA_PTR;
+
+struct stm32_qspi_regs {
+       u32 cr;         /* 0x00 */
+       u32 dcr;        /* 0x04 */
+       u32 sr;         /* 0x08 */
+       u32 fcr;        /* 0x0C */
+       u32 dlr;        /* 0x10 */
+       u32 ccr;        /* 0x14 */
+       u32 ar;         /* 0x18 */
+       u32 abr;        /* 0x1C */
+       u32 dr;         /* 0x20 */
+       u32 psmkr;      /* 0x24 */
+       u32 psmar;      /* 0x28 */
+       u32 pir;        /* 0x2C */
+       u32 lptr;       /* 0x30 */
+};
+
+/*
+ * QUADSPI control register
+ */
+#define STM32_QSPI_CR_EN               BIT(0)
+#define STM32_QSPI_CR_ABORT            BIT(1)
+#define STM32_QSPI_CR_DMAEN            BIT(2)
+#define STM32_QSPI_CR_TCEN             BIT(3)
+#define STM32_QSPI_CR_SSHIFT           BIT(4)
+#define STM32_QSPI_CR_DFM              BIT(6)
+#define STM32_QSPI_CR_FSEL             BIT(7)
+#define STM32_QSPI_CR_FTHRES_MASK      GENMASK(4, 0)
+#define STM32_QSPI_CR_FTHRES_SHIFT     (8)
+#define STM32_QSPI_CR_TEIE             BIT(16)
+#define STM32_QSPI_CR_TCIE             BIT(17)
+#define STM32_QSPI_CR_FTIE             BIT(18)
+#define STM32_QSPI_CR_SMIE             BIT(19)
+#define STM32_QSPI_CR_TOIE             BIT(20)
+#define STM32_QSPI_CR_APMS             BIT(22)
+#define STM32_QSPI_CR_PMM              BIT(23)
+#define STM32_QSPI_CR_PRESCALER_MASK   GENMASK(7, 0)
+#define STM32_QSPI_CR_PRESCALER_SHIFT  (24)
+
+/*
+ * QUADSPI device configuration register
+ */
+#define STM32_QSPI_DCR_CKMODE          BIT(0)
+#define STM32_QSPI_DCR_CSHT_MASK       GENMASK(2, 0)
+#define STM32_QSPI_DCR_CSHT_SHIFT      (8)
+#define STM32_QSPI_DCR_FSIZE_MASK      GENMASK(4, 0)
+#define STM32_QSPI_DCR_FSIZE_SHIFT     (16)
+
+/*
+ * QUADSPI status register
+ */
+#define STM32_QSPI_SR_TEF              BIT(0)
+#define STM32_QSPI_SR_TCF              BIT(1)
+#define STM32_QSPI_SR_FTF              BIT(2)
+#define STM32_QSPI_SR_SMF              BIT(3)
+#define STM32_QSPI_SR_TOF              BIT(4)
+#define STM32_QSPI_SR_BUSY             BIT(5)
+#define STM32_QSPI_SR_FLEVEL_MASK      GENMASK(5, 0)
+#define STM32_QSPI_SR_FLEVEL_SHIFT     (8)
+
+/*
+ * QUADSPI flag clear register
+ */
+#define STM32_QSPI_FCR_CTEF            BIT(0)
+#define STM32_QSPI_FCR_CTCF            BIT(1)
+#define STM32_QSPI_FCR_CSMF            BIT(3)
+#define STM32_QSPI_FCR_CTOF            BIT(4)
+
+/*
+ * QUADSPI communication configuration register
+ */
+#define STM32_QSPI_CCR_DDRM            BIT(31)
+#define STM32_QSPI_CCR_DHHC            BIT(30)
+#define STM32_QSPI_CCR_SIOO            BIT(28)
+#define STM32_QSPI_CCR_FMODE_SHIFT     (26)
+#define STM32_QSPI_CCR_DMODE_SHIFT     (24)
+#define STM32_QSPI_CCR_DCYC_SHIFT      (18)
+#define STM32_QSPI_CCR_DCYC_MASK       GENMASK(4, 0)
+#define STM32_QSPI_CCR_ABSIZE_SHIFT    (16)
+#define STM32_QSPI_CCR_ABMODE_SHIFT    (14)
+#define STM32_QSPI_CCR_ADSIZE_SHIFT    (12)
+#define STM32_QSPI_CCR_ADMODE_SHIFT    (10)
+#define STM32_QSPI_CCR_IMODE_SHIFT     (8)
+#define STM32_QSPI_CCR_INSTRUCTION_MASK        GENMASK(7, 0)
+
+enum STM32_QSPI_CCR_IMODE {
+       STM32_QSPI_CCR_IMODE_NONE = 0,
+       STM32_QSPI_CCR_IMODE_ONE_LINE = 1,
+       STM32_QSPI_CCR_IMODE_TWO_LINE = 2,
+       STM32_QSPI_CCR_IMODE_FOUR_LINE = 3,
+};
+
+enum STM32_QSPI_CCR_ADMODE {
+       STM32_QSPI_CCR_ADMODE_NONE = 0,
+       STM32_QSPI_CCR_ADMODE_ONE_LINE = 1,
+       STM32_QSPI_CCR_ADMODE_TWO_LINE = 2,
+       STM32_QSPI_CCR_ADMODE_FOUR_LINE = 3,
+};
+
+enum STM32_QSPI_CCR_ADSIZE {
+       STM32_QSPI_CCR_ADSIZE_8BIT = 0,
+       STM32_QSPI_CCR_ADSIZE_16BIT = 1,
+       STM32_QSPI_CCR_ADSIZE_24BIT = 2,
+       STM32_QSPI_CCR_ADSIZE_32BIT = 3,
+};
+
+enum STM32_QSPI_CCR_ABMODE {
+       STM32_QSPI_CCR_ABMODE_NONE = 0,
+       STM32_QSPI_CCR_ABMODE_ONE_LINE = 1,
+       STM32_QSPI_CCR_ABMODE_TWO_LINE = 2,
+       STM32_QSPI_CCR_ABMODE_FOUR_LINE = 3,
+};
+
+enum STM32_QSPI_CCR_ABSIZE {
+       STM32_QSPI_CCR_ABSIZE_8BIT = 0,
+       STM32_QSPI_CCR_ABSIZE_16BIT = 1,
+       STM32_QSPI_CCR_ABSIZE_24BIT = 2,
+       STM32_QSPI_CCR_ABSIZE_32BIT = 3,
+};
+
+enum STM32_QSPI_CCR_DMODE {
+       STM32_QSPI_CCR_DMODE_NONE = 0,
+       STM32_QSPI_CCR_DMODE_ONE_LINE = 1,
+       STM32_QSPI_CCR_DMODE_TWO_LINE = 2,
+       STM32_QSPI_CCR_DMODE_FOUR_LINE = 3,
+};
+
+enum STM32_QSPI_CCR_FMODE {
+       STM32_QSPI_CCR_IND_WRITE = 0,
+       STM32_QSPI_CCR_IND_READ = 1,
+       STM32_QSPI_CCR_AUTO_POLL = 2,
+       STM32_QSPI_CCR_MEM_MAP = 3,
+};
+
+/* default SCK frequency, unit: HZ */
+#define STM32_QSPI_DEFAULT_SCK_FREQ 108000000
+
+struct stm32_qspi_platdata {
+       u32 base;
+       u32 memory_map;
+       u32 max_hz;
+};
+
+struct stm32_qspi_priv {
+       struct stm32_qspi_regs *regs;
+       u32 max_hz;
+       u32 mode;
+
+       u32 command;
+       u32 address;
+       u32 dummycycles;
+#define CMD_HAS_ADR    BIT(24)
+#define CMD_HAS_DUMMY  BIT(25)
+#define CMD_HAS_DATA   BIT(26)
+};
+
+static void _stm32_qspi_disable(struct stm32_qspi_priv *priv)
+{
+       clrbits_le32(&priv->regs->cr, STM32_QSPI_CR_EN);
+}
+
+static void _stm32_qspi_enable(struct stm32_qspi_priv *priv)
+{
+       setbits_le32(&priv->regs->cr, STM32_QSPI_CR_EN);
+}
+
+static void _stm32_qspi_wait_for_not_busy(struct stm32_qspi_priv *priv)
+{
+       while (readl(&priv->regs->sr) & STM32_QSPI_SR_BUSY)
+               ;
+}
+
+static void _stm32_qspi_wait_for_complete(struct stm32_qspi_priv *priv)
+{
+       while (!(readl(&priv->regs->sr) & STM32_QSPI_SR_TCF))
+               ;
+}
+
+static void _stm32_qspi_wait_for_ftf(struct stm32_qspi_priv *priv)
+{
+       while (!(readl(&priv->regs->sr) & STM32_QSPI_SR_FTF))
+               ;
+}
+
+static void _stm32_qspi_set_flash_size(struct stm32_qspi_priv *priv, u32 size)
+{
+       u32 fsize = fls(size) - 1;
+       clrsetbits_le32(&priv->regs->dcr,
+                       STM32_QSPI_DCR_FSIZE_MASK << STM32_QSPI_DCR_FSIZE_SHIFT,
+                       fsize << STM32_QSPI_DCR_FSIZE_SHIFT);
+}
+
+static unsigned int _stm32_qspi_gen_ccr(struct stm32_qspi_priv *priv)
+{
+       unsigned int ccr_reg = 0;
+       u8 imode, admode, dmode;
+       u32 mode = priv->mode;
+       u32 cmd = (priv->command & STM32_QSPI_CCR_INSTRUCTION_MASK);
+
+       imode = STM32_QSPI_CCR_IMODE_ONE_LINE;
+       admode = STM32_QSPI_CCR_ADMODE_ONE_LINE;
+
+       if (mode & SPI_RX_QUAD) {
+               dmode = STM32_QSPI_CCR_DMODE_FOUR_LINE;
+               if (mode & SPI_TX_QUAD) {
+                       imode = STM32_QSPI_CCR_IMODE_FOUR_LINE;
+                       admode = STM32_QSPI_CCR_ADMODE_FOUR_LINE;
+               }
+       } else if (mode & SPI_RX_DUAL) {
+               dmode = STM32_QSPI_CCR_DMODE_TWO_LINE;
+               if (mode & SPI_TX_DUAL) {
+                       imode = STM32_QSPI_CCR_IMODE_TWO_LINE;
+                       admode = STM32_QSPI_CCR_ADMODE_TWO_LINE;
+               }
+       } else {
+               dmode = STM32_QSPI_CCR_DMODE_ONE_LINE;
+       }
+
+       if (priv->command & CMD_HAS_DATA)
+               ccr_reg |= (dmode << STM32_QSPI_CCR_DMODE_SHIFT);
+
+       if (priv->command & CMD_HAS_DUMMY)
+               ccr_reg |= ((priv->dummycycles & STM32_QSPI_CCR_DCYC_MASK)
+                               << STM32_QSPI_CCR_DCYC_SHIFT);
+
+       if (priv->command & CMD_HAS_ADR) {
+               ccr_reg |= (STM32_QSPI_CCR_ADSIZE_24BIT
+                               << STM32_QSPI_CCR_ADSIZE_SHIFT);
+               ccr_reg |= (admode << STM32_QSPI_CCR_ADMODE_SHIFT);
+       }
+       ccr_reg |= (imode << STM32_QSPI_CCR_IMODE_SHIFT);
+       ccr_reg |= cmd;
+       return ccr_reg;
+}
+
+static void _stm32_qspi_enable_mmap(struct stm32_qspi_priv *priv,
+               struct spi_flash *flash)
+{
+       priv->command = flash->read_cmd | CMD_HAS_ADR | CMD_HAS_DATA
+                       | CMD_HAS_DUMMY;
+       priv->dummycycles = flash->dummy_byte * 8;
+
+       unsigned int ccr_reg = _stm32_qspi_gen_ccr(priv);
+       ccr_reg |= (STM32_QSPI_CCR_MEM_MAP << STM32_QSPI_CCR_FMODE_SHIFT);
+
+       _stm32_qspi_wait_for_not_busy(priv);
+
+       writel(ccr_reg, &priv->regs->ccr);
+
+       priv->dummycycles = 0;
+}
+
+static void _stm32_qspi_disable_mmap(struct stm32_qspi_priv *priv)
+{
+       setbits_le32(&priv->regs->cr, STM32_QSPI_CR_ABORT);
+}
+
+static void _stm32_qspi_set_xfer_length(struct stm32_qspi_priv *priv,
+                                       u32 length)
+{
+       writel(length - 1, &priv->regs->dlr);
+}
+
+static void _stm32_qspi_start_xfer(struct stm32_qspi_priv *priv, u32 cr_reg)
+{
+       writel(cr_reg, &priv->regs->ccr);
+
+       if (priv->command & CMD_HAS_ADR)
+               writel(priv->address, &priv->regs->ar);
+}
+
+static int _stm32_qspi_xfer(struct stm32_qspi_priv *priv,
+               struct spi_flash *flash, unsigned int bitlen,
+               const u8 *dout, u8 *din, unsigned long flags)
+{
+       unsigned int words = bitlen / 8;
+
+       if (flags & SPI_XFER_MMAP) {
+               _stm32_qspi_enable_mmap(priv, flash);
+               return 0;
+       } else if (flags & SPI_XFER_MMAP_END) {
+               _stm32_qspi_disable_mmap(priv);
+               return 0;
+       }
+
+       if (bitlen == 0)
+               return -1;
+
+       if (bitlen % 8) {
+               debug("spi_xfer: Non byte aligned SPI transfer\n");
+               return -1;
+       }
+
+       if (dout && din) {
+               debug("spi_xfer: QSPI cannot have data in and data out set\n");
+               return -1;
+       }
+
+       if (!dout && (flags & SPI_XFER_BEGIN)) {
+               debug("spi_xfer: QSPI transfer must begin with command\n");
+               return -1;
+       }
+
+       if (dout) {
+               if (flags & SPI_XFER_BEGIN) {
+                       /* data is command */
+                       priv->command = dout[0] | CMD_HAS_DATA;
+                       if (words >= 4) {
+                               /* address is here too */
+                               priv->address = (dout[1] << 16) |
+                                               (dout[2] << 8) | dout[3];
+                               priv->command |= CMD_HAS_ADR;
+                       }
+
+                       if (words > 4) {
+                               /* rest is dummy bytes */
+                               priv->dummycycles = (words - 4) * 8;
+                               priv->command |= CMD_HAS_DUMMY;
+                       }
+
+                       if (flags & SPI_XFER_END) {
+                               /* command without data */
+                               priv->command &= ~(CMD_HAS_DATA);
+                       }
+               }
+
+               if (flags & SPI_XFER_END) {
+                       u32 ccr_reg = _stm32_qspi_gen_ccr(priv);
+                       ccr_reg |= STM32_QSPI_CCR_IND_WRITE
+                                       << STM32_QSPI_CCR_FMODE_SHIFT;
+
+                       _stm32_qspi_wait_for_not_busy(priv);
+
+                       if (priv->command & CMD_HAS_DATA)
+                               _stm32_qspi_set_xfer_length(priv, words);
+
+                       _stm32_qspi_start_xfer(priv, ccr_reg);
+
+                       debug("%s: write: ccr:0x%08x adr:0x%08x\n",
+                             __func__, priv->regs->ccr, priv->regs->ar);
+
+                       if (priv->command & CMD_HAS_DATA) {
+                               _stm32_qspi_wait_for_ftf(priv);
+
+                               debug("%s: words:%d data:", __func__, words);
+
+                               int i = 0;
+                               while (words > i) {
+                                       writeb(dout[i], &priv->regs->dr);
+                                       debug("%02x ", dout[i]);
+                                       i++;
+                               }
+                               debug("\n");
+
+                               _stm32_qspi_wait_for_complete(priv);
+                       } else {
+                               _stm32_qspi_wait_for_not_busy(priv);
+                       }
+               }
+       } else if (din) {
+               u32 ccr_reg = _stm32_qspi_gen_ccr(priv);
+               ccr_reg |= STM32_QSPI_CCR_IND_READ
+                               << STM32_QSPI_CCR_FMODE_SHIFT;
+
+               _stm32_qspi_wait_for_not_busy(priv);
+
+               _stm32_qspi_set_xfer_length(priv, words);
+
+               _stm32_qspi_start_xfer(priv, ccr_reg);
+
+               debug("%s: read: ccr:0x%08x adr:0x%08x len:%d\n", __func__,
+                     priv->regs->ccr, priv->regs->ar, priv->regs->dlr);
+
+               debug("%s: data:", __func__);
+
+               int i = 0;
+               while (words > i) {
+                       din[i] = readb(&priv->regs->dr);
+                       debug("%02x ", din[i]);
+                       i++;
+               }
+               debug("\n");
+       }
+
+       return 0;
+}
+
+static int stm32_qspi_ofdata_to_platdata(struct udevice *bus)
+{
+       struct fdt_resource res_regs, res_mem;
+       struct stm32_qspi_platdata *plat = bus->platdata;
+       const void *blob = gd->fdt_blob;
+       int node = bus->of_offset;
+       int ret;
+
+       ret = fdt_get_named_resource(blob, node, "reg", "reg-names",
+                                    "QuadSPI", &res_regs);
+       if (ret) {
+               debug("Error: can't get regs base addresses(ret = %d)!\n", ret);
+               return -ENOMEM;
+       }
+       ret = fdt_get_named_resource(blob, node, "reg", "reg-names",
+                                    "QuadSPI-memory", &res_mem);
+       if (ret) {
+               debug("Error: can't get mmap base address(ret = %d)!\n", ret);
+               return -ENOMEM;
+       }
+
+       plat->max_hz = fdtdec_get_int(blob, node, "spi-max-frequency",
+                                       STM32_QSPI_DEFAULT_SCK_FREQ);
+
+       plat->base = res_regs.start;
+       plat->memory_map = res_mem.start;
+
+       debug("%s: regs=<0x%x> mapped=<0x%x>, max-frequency=%d\n",
+             __func__,
+             plat->base,
+             plat->memory_map,
+             plat->max_hz
+             );
+
+       return 0;
+}
+
+static int stm32_qspi_probe(struct udevice *bus)
+{
+       struct stm32_qspi_platdata *plat = dev_get_platdata(bus);
+       struct stm32_qspi_priv *priv = dev_get_priv(bus);
+       struct dm_spi_bus *dm_spi_bus;
+
+       dm_spi_bus = bus->uclass_priv;
+
+       dm_spi_bus->max_hz = plat->max_hz;
+
+       priv->regs = (struct stm32_qspi_regs *)(uintptr_t)plat->base;
+
+       priv->max_hz = plat->max_hz;
+
+       clock_setup(QSPI_CLOCK_CFG);
+
+       setbits_le32(&priv->regs->cr, STM32_QSPI_CR_SSHIFT);
+
+       return 0;
+}
+
+static int stm32_qspi_remove(struct udevice *bus)
+{
+       return 0;
+}
+
+static int stm32_qspi_claim_bus(struct udevice *dev)
+{
+       struct stm32_qspi_priv *priv;
+       struct udevice *bus;
+       struct spi_flash *flash;
+
+       bus = dev->parent;
+       priv = dev_get_priv(bus);
+       flash = dev_get_uclass_priv(dev);
+
+       _stm32_qspi_set_flash_size(priv, flash->size);
+
+       _stm32_qspi_enable(priv);
+
+       return 0;
+}
+
+static int stm32_qspi_release_bus(struct udevice *dev)
+{
+       struct stm32_qspi_priv *priv;
+       struct udevice *bus;
+
+       bus = dev->parent;
+       priv = dev_get_priv(bus);
+
+       _stm32_qspi_disable(priv);
+
+       return 0;
+}
+
+static int stm32_qspi_xfer(struct udevice *dev, unsigned int bitlen,
+               const void *dout, void *din, unsigned long flags)
+{
+       struct stm32_qspi_priv *priv;
+       struct udevice *bus;
+       struct spi_flash *flash;
+
+       bus = dev->parent;
+       priv = dev_get_priv(bus);
+       flash = dev_get_uclass_priv(dev);
+
+       return _stm32_qspi_xfer(priv, flash, bitlen, (const u8 *)dout,
+                               (u8 *)din, flags);
+}
+
+static int stm32_qspi_set_speed(struct udevice *bus, uint speed)
+{
+       struct stm32_qspi_platdata *plat = bus->platdata;
+       struct stm32_qspi_priv *priv = dev_get_priv(bus);
+
+       if (speed > plat->max_hz)
+               speed = plat->max_hz;
+
+       u32 qspi_clk = clock_get(CLOCK_AHB);
+       u32 prescaler = 255;
+       if (speed > 0) {
+               prescaler = DIV_ROUND_UP(qspi_clk, speed) - 1;
+               if (prescaler > 255)
+                       prescaler = 255;
+               else if (prescaler < 0)
+                       prescaler = 0;
+       }
+
+       u32 csht = DIV_ROUND_UP((5 * qspi_clk) / (prescaler + 1), 100000000);
+       csht = (csht - 1) & STM32_QSPI_DCR_CSHT_MASK;
+
+       _stm32_qspi_wait_for_not_busy(priv);
+
+       clrsetbits_le32(&priv->regs->cr,
+                       STM32_QSPI_CR_PRESCALER_MASK <<
+                       STM32_QSPI_CR_PRESCALER_SHIFT,
+                       prescaler << STM32_QSPI_CR_PRESCALER_SHIFT);
+
+
+       clrsetbits_le32(&priv->regs->dcr,
+                       STM32_QSPI_DCR_CSHT_MASK << STM32_QSPI_DCR_CSHT_SHIFT,
+                       csht << STM32_QSPI_DCR_CSHT_SHIFT);
+
+       debug("%s: regs=%p, speed=%d\n", __func__, priv->regs,
+             (qspi_clk / (prescaler + 1)));
+
+       return 0;
+}
+
+static int stm32_qspi_set_mode(struct udevice *bus, uint mode)
+{
+       struct stm32_qspi_priv *priv = dev_get_priv(bus);
+
+       _stm32_qspi_wait_for_not_busy(priv);
+
+       if ((mode & SPI_CPHA) && (mode & SPI_CPOL))
+               setbits_le32(&priv->regs->dcr, STM32_QSPI_DCR_CKMODE);
+       else if (!(mode & SPI_CPHA) && !(mode & SPI_CPOL))
+               clrbits_le32(&priv->regs->dcr, STM32_QSPI_DCR_CKMODE);
+       else
+               return -ENODEV;
+
+       if (mode & SPI_CS_HIGH)
+               return -ENODEV;
+
+       if (mode & SPI_RX_QUAD)
+               priv->mode |= SPI_RX_QUAD;
+       else if (mode & SPI_RX_DUAL)
+               priv->mode |= SPI_RX_DUAL;
+       else
+               priv->mode &= ~(SPI_RX_QUAD | SPI_RX_DUAL);
+
+       if (mode & SPI_TX_QUAD)
+               priv->mode |= SPI_TX_QUAD;
+       else if (mode & SPI_TX_DUAL)
+               priv->mode |= SPI_TX_DUAL;
+       else
+               priv->mode &= ~(SPI_TX_QUAD | SPI_TX_DUAL);
+
+       debug("%s: regs=%p, mode=%d rx: ", __func__, priv->regs, mode);
+
+       if (mode & SPI_RX_QUAD)
+               debug("quad, tx: ");
+       else if (mode & SPI_RX_DUAL)
+               debug("dual, tx: ");
+       else
+               debug("single, tx: ");
+
+       if (mode & SPI_TX_QUAD)
+               debug("quad\n");
+       else if (mode & SPI_TX_DUAL)
+               debug("dual\n");
+       else
+               debug("single\n");
+
+       return 0;
+}
+
+static const struct dm_spi_ops stm32_qspi_ops = {
+       .claim_bus      = stm32_qspi_claim_bus,
+       .release_bus    = stm32_qspi_release_bus,
+       .xfer           = stm32_qspi_xfer,
+       .set_speed      = stm32_qspi_set_speed,
+       .set_mode       = stm32_qspi_set_mode,
+};
+
+static const struct udevice_id stm32_qspi_ids[] = {
+       { .compatible = "st,stm32-qspi" },
+       { }
+};
+
+U_BOOT_DRIVER(stm32_qspi) = {
+       .name   = "stm32_qspi",
+       .id     = UCLASS_SPI,
+       .of_match = stm32_qspi_ids,
+       .ops    = &stm32_qspi_ops,
+       .ofdata_to_platdata = stm32_qspi_ofdata_to_platdata,
+       .platdata_auto_alloc_size = sizeof(struct stm32_qspi_platdata),
+       .priv_auto_alloc_size = sizeof(struct stm32_qspi_priv),
+       .probe  = stm32_qspi_probe,
+       .remove = stm32_qspi_remove,
+};