Message ID | 1596182024-18181-8-git-send-email-christophe.kerello@st.com |
---|---|
State | Accepted |
Commit | 6d47598629f63fa05ef51a0628f971c14c800874 |
Delegated to: | Patrice Chotard |
Headers | show |
Series | Add STM32 FMC2 EBI controller driver | expand |
Hi Christophe On 7/31/20 9:53 AM, Christophe Kerello wrote: > The driver adds the support for the STMicroelectronics FMC2 EBI controller > found on STM32MP SOCs. > > Signed-off-by: Christophe Kerello <christophe.kerello@st.com> > --- > > drivers/memory/Kconfig | 9 + > drivers/memory/Makefile | 1 + > drivers/memory/stm32-fmc2-ebi.c | 1056 +++++++++++++++++++++++++++++++++++++++ > 3 files changed, 1066 insertions(+) > create mode 100644 drivers/memory/stm32-fmc2-ebi.c > > diff --git a/drivers/memory/Kconfig b/drivers/memory/Kconfig > index 4fbb5aa..7271892 100644 > --- a/drivers/memory/Kconfig > +++ b/drivers/memory/Kconfig > @@ -4,6 +4,15 @@ > > menu "Memory Controller drivers" > > +config STM32_FMC2_EBI > + bool "Support for FMC2 External Bus Interface on STM32MP SoCs" > + depends on ARCH_STM32MP > + help > + Select this option to enable the STM32 FMC2 External Bus Interface > + controller. This driver configures the transactions with external > + devices (like SRAM, ethernet adapters, FPGAs, LCD displays, ...) on > + SOCs containing the FMC2 External Bus Interface. > + > config TI_AEMIF > tristate "Texas Instruments AEMIF driver" > depends on ARCH_KEYSTONE > diff --git a/drivers/memory/Makefile b/drivers/memory/Makefile > index 238add0..fec52ef 100644 > --- a/drivers/memory/Makefile > +++ b/drivers/memory/Makefile > @@ -1,2 +1,3 @@ > > +obj-$(CONFIG_STM32_FMC2_EBI) += stm32-fmc2-ebi.o > obj-$(CONFIG_TI_AEMIF) += ti-aemif.o > diff --git a/drivers/memory/stm32-fmc2-ebi.c b/drivers/memory/stm32-fmc2-ebi.c > new file mode 100644 > index 0000000..d887a1e > --- /dev/null > +++ b/drivers/memory/stm32-fmc2-ebi.c > @@ -0,0 +1,1056 @@ > +// SPDX-License-Identifier: GPL-2.0+ OR BSD-3-Clause > +/* > + * Copyright (C) STMicroelectronics 2020 > + */ > + > +#include <common.h> > +#include <clk.h> > +#include <dm.h> > +#include <reset.h> > +#include <linux/bitfield.h> > +#include <linux/err.h> > +#include <linux/iopoll.h> > +#include <linux/ioport.h> > + > +/* FMC2 Controller Registers */ > +#define FMC2_BCR1 0x0 > +#define FMC2_BTR1 0x4 > +#define FMC2_BCR(x) ((x) * 0x8 + FMC2_BCR1) > +#define FMC2_BTR(x) ((x) * 0x8 + FMC2_BTR1) > +#define FMC2_PCSCNTR 0x20 > +#define FMC2_BWTR1 0x104 > +#define FMC2_BWTR(x) ((x) * 0x8 + FMC2_BWTR1) > + > +/* Register: FMC2_BCR1 */ > +#define FMC2_BCR1_CCLKEN BIT(20) > +#define FMC2_BCR1_FMC2EN BIT(31) > + > +/* Register: FMC2_BCRx */ > +#define FMC2_BCR_MBKEN BIT(0) > +#define FMC2_BCR_MUXEN BIT(1) > +#define FMC2_BCR_MTYP GENMASK(3, 2) > +#define FMC2_BCR_MWID GENMASK(5, 4) > +#define FMC2_BCR_FACCEN BIT(6) > +#define FMC2_BCR_BURSTEN BIT(8) > +#define FMC2_BCR_WAITPOL BIT(9) > +#define FMC2_BCR_WAITCFG BIT(11) > +#define FMC2_BCR_WREN BIT(12) > +#define FMC2_BCR_WAITEN BIT(13) > +#define FMC2_BCR_EXTMOD BIT(14) > +#define FMC2_BCR_ASYNCWAIT BIT(15) > +#define FMC2_BCR_CPSIZE GENMASK(18, 16) > +#define FMC2_BCR_CBURSTRW BIT(19) > +#define FMC2_BCR_NBLSET GENMASK(23, 22) > + > +/* Register: FMC2_BTRx/FMC2_BWTRx */ > +#define FMC2_BXTR_ADDSET GENMASK(3, 0) > +#define FMC2_BXTR_ADDHLD GENMASK(7, 4) > +#define FMC2_BXTR_DATAST GENMASK(15, 8) > +#define FMC2_BXTR_BUSTURN GENMASK(19, 16) > +#define FMC2_BTR_CLKDIV GENMASK(23, 20) > +#define FMC2_BTR_DATLAT GENMASK(27, 24) > +#define FMC2_BXTR_ACCMOD GENMASK(29, 28) > +#define FMC2_BXTR_DATAHLD GENMASK(31, 30) > + > +/* Register: FMC2_PCSCNTR */ > +#define FMC2_PCSCNTR_CSCOUNT GENMASK(15, 0) > +#define FMC2_PCSCNTR_CNTBEN(x) BIT((x) + 16) > + > +#define FMC2_MAX_EBI_CE 4 > +#define FMC2_MAX_BANKS 5 > + > +#define FMC2_BCR_CPSIZE_0 0x0 > +#define FMC2_BCR_CPSIZE_128 0x1 > +#define FMC2_BCR_CPSIZE_256 0x2 > +#define FMC2_BCR_CPSIZE_512 0x3 > +#define FMC2_BCR_CPSIZE_1024 0x4 > + > +#define FMC2_BCR_MWID_8 0x0 > +#define FMC2_BCR_MWID_16 0x1 > + > +#define FMC2_BCR_MTYP_SRAM 0x0 > +#define FMC2_BCR_MTYP_PSRAM 0x1 > +#define FMC2_BCR_MTYP_NOR 0x2 > + > +#define FMC2_BXTR_EXTMOD_A 0x0 > +#define FMC2_BXTR_EXTMOD_B 0x1 > +#define FMC2_BXTR_EXTMOD_C 0x2 > +#define FMC2_BXTR_EXTMOD_D 0x3 > + > +#define FMC2_BCR_NBLSET_MAX 0x3 > +#define FMC2_BXTR_ADDSET_MAX 0xf > +#define FMC2_BXTR_ADDHLD_MAX 0xf > +#define FMC2_BXTR_DATAST_MAX 0xff > +#define FMC2_BXTR_BUSTURN_MAX 0xf > +#define FMC2_BXTR_DATAHLD_MAX 0x3 > +#define FMC2_BTR_CLKDIV_MAX 0xf > +#define FMC2_BTR_DATLAT_MAX 0xf > +#define FMC2_PCSCNTR_CSCOUNT_MAX 0xff > + > +#define FMC2_NSEC_PER_SEC 1000000000L > + > +enum stm32_fmc2_ebi_bank { > + FMC2_EBI1 = 0, > + FMC2_EBI2, > + FMC2_EBI3, > + FMC2_EBI4, > + FMC2_NAND > +}; > + > +enum stm32_fmc2_ebi_register_type { > + FMC2_REG_BCR = 1, > + FMC2_REG_BTR, > + FMC2_REG_BWTR, > + FMC2_REG_PCSCNTR > +}; > + > +enum stm32_fmc2_ebi_transaction_type { > + FMC2_ASYNC_MODE_1_SRAM = 0, > + FMC2_ASYNC_MODE_1_PSRAM, > + FMC2_ASYNC_MODE_A_SRAM, > + FMC2_ASYNC_MODE_A_PSRAM, > + FMC2_ASYNC_MODE_2_NOR, > + FMC2_ASYNC_MODE_B_NOR, > + FMC2_ASYNC_MODE_C_NOR, > + FMC2_ASYNC_MODE_D_NOR, > + FMC2_SYNC_READ_SYNC_WRITE_PSRAM, > + FMC2_SYNC_READ_ASYNC_WRITE_PSRAM, > + FMC2_SYNC_READ_SYNC_WRITE_NOR, > + FMC2_SYNC_READ_ASYNC_WRITE_NOR > +}; > + > +enum stm32_fmc2_ebi_buswidth { > + FMC2_BUSWIDTH_8 = 8, > + FMC2_BUSWIDTH_16 = 16 > +}; > + > +enum stm32_fmc2_ebi_cpsize { > + FMC2_CPSIZE_0 = 0, > + FMC2_CPSIZE_128 = 128, > + FMC2_CPSIZE_256 = 256, > + FMC2_CPSIZE_512 = 512, > + FMC2_CPSIZE_1024 = 1024 > +}; > + > +struct stm32_fmc2_ebi { > + struct clk clk; > + fdt_addr_t io_base; > + u8 bank_assigned; > +}; > + > +/* > + * struct stm32_fmc2_prop - STM32 FMC2 EBI property > + * @name: the device tree binding name of the property > + * @bprop: indicate that it is a boolean property > + * @mprop: indicate that it is a mandatory property > + * @reg_type: the register that have to be modified > + * @reg_mask: the bit that have to be modified in the selected register > + * in case of it is a boolean property > + * @reset_val: the default value that have to be set in case the property > + * has not been defined in the device tree > + * @check: this callback ckecks that the property is compliant with the > + * transaction type selected > + * @calculate: this callback is called to calculate for exemple a timing > + * set in nanoseconds in the device tree in clock cycles or in > + * clock period > + * @set: this callback applies the values in the registers > + */ > +struct stm32_fmc2_prop { > + const char *name; > + bool bprop; > + bool mprop; > + int reg_type; > + u32 reg_mask; > + u32 reset_val; > + int (*check)(struct stm32_fmc2_ebi *ebi, > + const struct stm32_fmc2_prop *prop, int cs); > + u32 (*calculate)(struct stm32_fmc2_ebi *ebi, int cs, u32 setup); > + int (*set)(struct stm32_fmc2_ebi *ebi, > + const struct stm32_fmc2_prop *prop, > + int cs, u32 setup); > +}; > + > +static int stm32_fmc2_ebi_check_mux(struct stm32_fmc2_ebi *ebi, > + const struct stm32_fmc2_prop *prop, > + int cs) > +{ > + u32 bcr = readl(ebi->io_base + FMC2_BCR(cs)); > + > + if (bcr & FMC2_BCR_MTYP) > + return 0; > + > + return -EINVAL; > +} > + > +static int stm32_fmc2_ebi_check_waitcfg(struct stm32_fmc2_ebi *ebi, > + const struct stm32_fmc2_prop *prop, > + int cs) > +{ > + u32 bcr = readl(ebi->io_base + FMC2_BCR(cs)); > + u32 val = FIELD_PREP(FMC2_BCR_MTYP, FMC2_BCR_MTYP_NOR); > + > + if ((bcr & FMC2_BCR_MTYP) == val && bcr & FMC2_BCR_BURSTEN) > + return 0; > + > + return -EINVAL; > +} > + > +static int stm32_fmc2_ebi_check_sync_trans(struct stm32_fmc2_ebi *ebi, > + const struct stm32_fmc2_prop *prop, > + int cs) > +{ > + u32 bcr = readl(ebi->io_base + FMC2_BCR(cs)); > + > + if (bcr & FMC2_BCR_BURSTEN) > + return 0; > + > + return -EINVAL; > +} > + > +static int stm32_fmc2_ebi_check_async_trans(struct stm32_fmc2_ebi *ebi, > + const struct stm32_fmc2_prop *prop, > + int cs) > +{ > + u32 bcr = readl(ebi->io_base + FMC2_BCR(cs)); > + > + if (!(bcr & FMC2_BCR_BURSTEN) || !(bcr & FMC2_BCR_CBURSTRW)) > + return 0; > + > + return -EINVAL; > +} > + > +static int stm32_fmc2_ebi_check_cpsize(struct stm32_fmc2_ebi *ebi, > + const struct stm32_fmc2_prop *prop, > + int cs) > +{ > + u32 bcr = readl(ebi->io_base + FMC2_BCR(cs)); > + u32 val = FIELD_PREP(FMC2_BCR_MTYP, FMC2_BCR_MTYP_PSRAM); > + > + if ((bcr & FMC2_BCR_MTYP) == val && bcr & FMC2_BCR_BURSTEN) > + return 0; > + > + return -EINVAL; > +} > + > +static int stm32_fmc2_ebi_check_address_hold(struct stm32_fmc2_ebi *ebi, > + const struct stm32_fmc2_prop *prop, > + int cs) > +{ > + u32 bcr = readl(ebi->io_base + FMC2_BCR(cs)); > + u32 bxtr = prop->reg_type == FMC2_REG_BWTR ? > + readl(ebi->io_base + FMC2_BWTR(cs)) : > + readl(ebi->io_base + FMC2_BTR(cs)); > + u32 val = FIELD_PREP(FMC2_BXTR_ACCMOD, FMC2_BXTR_EXTMOD_D); > + > + if ((!(bcr & FMC2_BCR_BURSTEN) || !(bcr & FMC2_BCR_CBURSTRW)) && > + ((bxtr & FMC2_BXTR_ACCMOD) == val || bcr & FMC2_BCR_MUXEN)) > + return 0; > + > + return -EINVAL; > +} > + > +static int stm32_fmc2_ebi_check_clk_period(struct stm32_fmc2_ebi *ebi, > + const struct stm32_fmc2_prop *prop, > + int cs) > +{ > + u32 bcr = readl(ebi->io_base + FMC2_BCR(cs)); > + u32 bcr1 = cs ? readl(ebi->io_base + FMC2_BCR1) : bcr; > + > + if (bcr & FMC2_BCR_BURSTEN && (!cs || !(bcr1 & FMC2_BCR1_CCLKEN))) > + return 0; > + > + return -EINVAL; > +} > + > +static int stm32_fmc2_ebi_check_cclk(struct stm32_fmc2_ebi *ebi, > + const struct stm32_fmc2_prop *prop, > + int cs) > +{ > + if (cs) > + return -EINVAL; > + > + return stm32_fmc2_ebi_check_sync_trans(ebi, prop, cs); > +} > + > +static u32 stm32_fmc2_ebi_ns_to_clock_cycles(struct stm32_fmc2_ebi *ebi, > + int cs, u32 setup) > +{ > + unsigned long hclk = clk_get_rate(&ebi->clk); > + unsigned long hclkp = FMC2_NSEC_PER_SEC / (hclk / 1000); > + > + return DIV_ROUND_UP(setup * 1000, hclkp); > +} > + > +static u32 stm32_fmc2_ebi_ns_to_clk_period(struct stm32_fmc2_ebi *ebi, > + int cs, u32 setup) > +{ > + u32 nb_clk_cycles = stm32_fmc2_ebi_ns_to_clock_cycles(ebi, cs, setup); > + u32 bcr = readl(ebi->io_base + FMC2_BCR1); > + u32 btr = bcr & FMC2_BCR1_CCLKEN || !cs ? > + readl(ebi->io_base + FMC2_BTR1) : > + readl(ebi->io_base + FMC2_BTR(cs)); > + u32 clk_period = FIELD_GET(FMC2_BTR_CLKDIV, btr) + 1; > + > + return DIV_ROUND_UP(nb_clk_cycles, clk_period); > +} > + > +static int stm32_fmc2_ebi_get_reg(int reg_type, int cs, u32 *reg) > +{ > + switch (reg_type) { > + case FMC2_REG_BCR: > + *reg = FMC2_BCR(cs); > + break; > + case FMC2_REG_BTR: > + *reg = FMC2_BTR(cs); > + break; > + case FMC2_REG_BWTR: > + *reg = FMC2_BWTR(cs); > + break; > + case FMC2_REG_PCSCNTR: > + *reg = FMC2_PCSCNTR; > + break; > + default: > + return -EINVAL; > + } > + > + return 0; > +} > + > +static int stm32_fmc2_ebi_set_bit_field(struct stm32_fmc2_ebi *ebi, > + const struct stm32_fmc2_prop *prop, > + int cs, u32 setup) > +{ > + u32 reg; > + int ret; > + > + ret = stm32_fmc2_ebi_get_reg(prop->reg_type, cs, ®); > + if (ret) > + return ret; > + > + clrsetbits_le32(ebi->io_base + reg, prop->reg_mask, > + setup ? prop->reg_mask : 0); > + > + return 0; > +} > + > +static int stm32_fmc2_ebi_set_trans_type(struct stm32_fmc2_ebi *ebi, > + const struct stm32_fmc2_prop *prop, > + int cs, u32 setup) > +{ > + u32 bcr_mask, bcr = FMC2_BCR_WREN; > + u32 btr_mask, btr = 0; > + u32 bwtr_mask, bwtr = 0; > + > + bwtr_mask = FMC2_BXTR_ACCMOD; > + btr_mask = FMC2_BXTR_ACCMOD; > + bcr_mask = FMC2_BCR_MUXEN | FMC2_BCR_MTYP | FMC2_BCR_FACCEN | > + FMC2_BCR_WREN | FMC2_BCR_WAITEN | FMC2_BCR_BURSTEN | > + FMC2_BCR_EXTMOD | FMC2_BCR_CBURSTRW; > + > + switch (setup) { > + case FMC2_ASYNC_MODE_1_SRAM: > + bcr |= FIELD_PREP(FMC2_BCR_MTYP, FMC2_BCR_MTYP_SRAM); > + /* > + * MUXEN = 0, MTYP = 0, FACCEN = 0, BURSTEN = 0, WAITEN = 0, > + * WREN = 1, EXTMOD = 0, CBURSTRW = 0, ACCMOD = 0 > + */ > + break; > + case FMC2_ASYNC_MODE_1_PSRAM: > + /* > + * MUXEN = 0, MTYP = 1, FACCEN = 0, BURSTEN = 0, WAITEN = 0, > + * WREN = 1, EXTMOD = 0, CBURSTRW = 0, ACCMOD = 0 > + */ > + bcr |= FIELD_PREP(FMC2_BCR_MTYP, FMC2_BCR_MTYP_PSRAM); > + break; > + case FMC2_ASYNC_MODE_A_SRAM: > + /* > + * MUXEN = 0, MTYP = 0, FACCEN = 0, BURSTEN = 0, WAITEN = 0, > + * WREN = 1, EXTMOD = 1, CBURSTRW = 0, ACCMOD = 0 > + */ > + bcr |= FIELD_PREP(FMC2_BCR_MTYP, FMC2_BCR_MTYP_SRAM); > + bcr |= FMC2_BCR_EXTMOD; > + btr |= FIELD_PREP(FMC2_BXTR_ACCMOD, FMC2_BXTR_EXTMOD_A); > + bwtr |= FIELD_PREP(FMC2_BXTR_ACCMOD, FMC2_BXTR_EXTMOD_A); > + break; > + case FMC2_ASYNC_MODE_A_PSRAM: > + /* > + * MUXEN = 0, MTYP = 1, FACCEN = 0, BURSTEN = 0, WAITEN = 0, > + * WREN = 1, EXTMOD = 1, CBURSTRW = 0, ACCMOD = 0 > + */ > + bcr |= FIELD_PREP(FMC2_BCR_MTYP, FMC2_BCR_MTYP_PSRAM); > + bcr |= FMC2_BCR_EXTMOD; > + btr |= FIELD_PREP(FMC2_BXTR_ACCMOD, FMC2_BXTR_EXTMOD_A); > + bwtr |= FIELD_PREP(FMC2_BXTR_ACCMOD, FMC2_BXTR_EXTMOD_A); > + break; > + case FMC2_ASYNC_MODE_2_NOR: > + /* > + * MUXEN = 0, MTYP = 2, FACCEN = 1, BURSTEN = 0, WAITEN = 0, > + * WREN = 1, EXTMOD = 0, CBURSTRW = 0, ACCMOD = 0 > + */ > + bcr |= FIELD_PREP(FMC2_BCR_MTYP, FMC2_BCR_MTYP_NOR); > + bcr |= FMC2_BCR_FACCEN; > + break; > + case FMC2_ASYNC_MODE_B_NOR: > + /* > + * MUXEN = 0, MTYP = 2, FACCEN = 1, BURSTEN = 0, WAITEN = 0, > + * WREN = 1, EXTMOD = 1, CBURSTRW = 0, ACCMOD = 1 > + */ > + bcr |= FIELD_PREP(FMC2_BCR_MTYP, FMC2_BCR_MTYP_NOR); > + bcr |= FMC2_BCR_FACCEN | FMC2_BCR_EXTMOD; > + btr |= FIELD_PREP(FMC2_BXTR_ACCMOD, FMC2_BXTR_EXTMOD_B); > + bwtr |= FIELD_PREP(FMC2_BXTR_ACCMOD, FMC2_BXTR_EXTMOD_B); > + break; > + case FMC2_ASYNC_MODE_C_NOR: > + /* > + * MUXEN = 0, MTYP = 2, FACCEN = 1, BURSTEN = 0, WAITEN = 0, > + * WREN = 1, EXTMOD = 1, CBURSTRW = 0, ACCMOD = 2 > + */ > + bcr |= FIELD_PREP(FMC2_BCR_MTYP, FMC2_BCR_MTYP_NOR); > + bcr |= FMC2_BCR_FACCEN | FMC2_BCR_EXTMOD; > + btr |= FIELD_PREP(FMC2_BXTR_ACCMOD, FMC2_BXTR_EXTMOD_C); > + bwtr |= FIELD_PREP(FMC2_BXTR_ACCMOD, FMC2_BXTR_EXTMOD_C); > + break; > + case FMC2_ASYNC_MODE_D_NOR: > + /* > + * MUXEN = 0, MTYP = 2, FACCEN = 1, BURSTEN = 0, WAITEN = 0, > + * WREN = 1, EXTMOD = 1, CBURSTRW = 0, ACCMOD = 3 > + */ > + bcr |= FIELD_PREP(FMC2_BCR_MTYP, FMC2_BCR_MTYP_NOR); > + bcr |= FMC2_BCR_FACCEN | FMC2_BCR_EXTMOD; > + btr |= FIELD_PREP(FMC2_BXTR_ACCMOD, FMC2_BXTR_EXTMOD_D); > + bwtr |= FIELD_PREP(FMC2_BXTR_ACCMOD, FMC2_BXTR_EXTMOD_D); > + break; > + case FMC2_SYNC_READ_SYNC_WRITE_PSRAM: > + /* > + * MUXEN = 0, MTYP = 1, FACCEN = 0, BURSTEN = 1, WAITEN = 0, > + * WREN = 1, EXTMOD = 0, CBURSTRW = 1, ACCMOD = 0 > + */ > + bcr |= FIELD_PREP(FMC2_BCR_MTYP, FMC2_BCR_MTYP_PSRAM); > + bcr |= FMC2_BCR_BURSTEN | FMC2_BCR_CBURSTRW; > + break; > + case FMC2_SYNC_READ_ASYNC_WRITE_PSRAM: > + /* > + * MUXEN = 0, MTYP = 1, FACCEN = 0, BURSTEN = 1, WAITEN = 0, > + * WREN = 1, EXTMOD = 0, CBURSTRW = 0, ACCMOD = 0 > + */ > + bcr |= FIELD_PREP(FMC2_BCR_MTYP, FMC2_BCR_MTYP_PSRAM); > + bcr |= FMC2_BCR_BURSTEN; > + break; > + case FMC2_SYNC_READ_SYNC_WRITE_NOR: > + /* > + * MUXEN = 0, MTYP = 2, FACCEN = 1, BURSTEN = 1, WAITEN = 0, > + * WREN = 1, EXTMOD = 0, CBURSTRW = 1, ACCMOD = 0 > + */ > + bcr |= FIELD_PREP(FMC2_BCR_MTYP, FMC2_BCR_MTYP_NOR); > + bcr |= FMC2_BCR_FACCEN | FMC2_BCR_BURSTEN | FMC2_BCR_CBURSTRW; > + break; > + case FMC2_SYNC_READ_ASYNC_WRITE_NOR: > + /* > + * MUXEN = 0, MTYP = 2, FACCEN = 1, BURSTEN = 1, WAITEN = 0, > + * WREN = 1, EXTMOD = 0, CBURSTRW = 0, ACCMOD = 0 > + */ > + bcr |= FIELD_PREP(FMC2_BCR_MTYP, FMC2_BCR_MTYP_NOR); > + bcr |= FMC2_BCR_FACCEN | FMC2_BCR_BURSTEN; > + break; > + default: > + /* Type of transaction not supported */ > + return -EINVAL; > + } > + > + if (bcr & FMC2_BCR_EXTMOD) > + clrsetbits_le32(ebi->io_base + FMC2_BWTR(cs), > + bwtr_mask, bwtr); > + clrsetbits_le32(ebi->io_base + FMC2_BTR(cs), btr_mask, btr); > + clrsetbits_le32(ebi->io_base + FMC2_BCR(cs), bcr_mask, bcr); > + > + return 0; > +} > + > +static int stm32_fmc2_ebi_set_buswidth(struct stm32_fmc2_ebi *ebi, > + const struct stm32_fmc2_prop *prop, > + int cs, u32 setup) > +{ > + u32 val; > + > + switch (setup) { > + case FMC2_BUSWIDTH_8: > + val = FIELD_PREP(FMC2_BCR_MWID, FMC2_BCR_MWID_8); > + break; > + case FMC2_BUSWIDTH_16: > + val = FIELD_PREP(FMC2_BCR_MWID, FMC2_BCR_MWID_16); > + break; > + default: > + /* Buswidth not supported */ > + return -EINVAL; > + } > + > + clrsetbits_le32(ebi->io_base + FMC2_BCR(cs), FMC2_BCR_MWID, val); > + > + return 0; > +} > + > +static int stm32_fmc2_ebi_set_cpsize(struct stm32_fmc2_ebi *ebi, > + const struct stm32_fmc2_prop *prop, > + int cs, u32 setup) > +{ > + u32 val; > + > + switch (setup) { > + case FMC2_CPSIZE_0: > + val = FIELD_PREP(FMC2_BCR_CPSIZE, FMC2_BCR_CPSIZE_0); > + break; > + case FMC2_CPSIZE_128: > + val = FIELD_PREP(FMC2_BCR_CPSIZE, FMC2_BCR_CPSIZE_128); > + break; > + case FMC2_CPSIZE_256: > + val = FIELD_PREP(FMC2_BCR_CPSIZE, FMC2_BCR_CPSIZE_256); > + break; > + case FMC2_CPSIZE_512: > + val = FIELD_PREP(FMC2_BCR_CPSIZE, FMC2_BCR_CPSIZE_512); > + break; > + case FMC2_CPSIZE_1024: > + val = FIELD_PREP(FMC2_BCR_CPSIZE, FMC2_BCR_CPSIZE_1024); > + break; > + default: > + /* Cpsize not supported */ > + return -EINVAL; > + } > + > + clrsetbits_le32(ebi->io_base + FMC2_BCR(cs), FMC2_BCR_CPSIZE, val); > + > + return 0; > +} > + > +static int stm32_fmc2_ebi_set_bl_setup(struct stm32_fmc2_ebi *ebi, > + const struct stm32_fmc2_prop *prop, > + int cs, u32 setup) > +{ > + u32 val; > + > + val = min_t(u32, setup, FMC2_BCR_NBLSET_MAX); > + val = FIELD_PREP(FMC2_BCR_NBLSET, val); > + clrsetbits_le32(ebi->io_base + FMC2_BCR(cs), FMC2_BCR_NBLSET, val); > + > + return 0; > +} > + > +static int stm32_fmc2_ebi_set_address_setup(struct stm32_fmc2_ebi *ebi, > + const struct stm32_fmc2_prop *prop, > + int cs, u32 setup) > +{ > + u32 bcr = readl(ebi->io_base + FMC2_BCR(cs)); > + u32 bxtr = prop->reg_type == FMC2_REG_BWTR ? > + readl(ebi->io_base + FMC2_BWTR(cs)) : > + readl(ebi->io_base + FMC2_BTR(cs)); > + u32 reg, val = FIELD_PREP(FMC2_BXTR_ACCMOD, FMC2_BXTR_EXTMOD_D); > + int ret; > + > + ret = stm32_fmc2_ebi_get_reg(prop->reg_type, cs, ®); > + if (ret) > + return ret; > + > + if ((bxtr & FMC2_BXTR_ACCMOD) == val || bcr & FMC2_BCR_MUXEN) > + val = clamp_val(setup, 1, FMC2_BXTR_ADDSET_MAX); > + else > + val = min_t(u32, setup, FMC2_BXTR_ADDSET_MAX); > + val = FIELD_PREP(FMC2_BXTR_ADDSET, val); > + clrsetbits_le32(ebi->io_base + reg, FMC2_BXTR_ADDSET, val); > + > + return 0; > +} > + > +static int stm32_fmc2_ebi_set_address_hold(struct stm32_fmc2_ebi *ebi, > + const struct stm32_fmc2_prop *prop, > + int cs, u32 setup) > +{ > + u32 val, reg; > + int ret; > + > + ret = stm32_fmc2_ebi_get_reg(prop->reg_type, cs, ®); > + if (ret) > + return ret; > + > + val = clamp_val(setup, 1, FMC2_BXTR_ADDHLD_MAX); > + val = FIELD_PREP(FMC2_BXTR_ADDHLD, val); > + clrsetbits_le32(ebi->io_base + reg, FMC2_BXTR_ADDHLD, val); > + > + return 0; > +} > + > +static int stm32_fmc2_ebi_set_data_setup(struct stm32_fmc2_ebi *ebi, > + const struct stm32_fmc2_prop *prop, > + int cs, u32 setup) > +{ > + u32 val, reg; > + int ret; > + > + ret = stm32_fmc2_ebi_get_reg(prop->reg_type, cs, ®); > + if (ret) > + return ret; > + > + val = clamp_val(setup, 1, FMC2_BXTR_DATAST_MAX); > + val = FIELD_PREP(FMC2_BXTR_DATAST, val); > + clrsetbits_le32(ebi->io_base + reg, FMC2_BXTR_DATAST, val); > + > + return 0; > +} > + > +static int stm32_fmc2_ebi_set_bus_turnaround(struct stm32_fmc2_ebi *ebi, > + const struct stm32_fmc2_prop *prop, > + int cs, u32 setup) > +{ > + u32 val, reg; > + int ret; > + > + ret = stm32_fmc2_ebi_get_reg(prop->reg_type, cs, ®); > + if (ret) > + return ret; > + > + val = setup ? min_t(u32, setup - 1, FMC2_BXTR_BUSTURN_MAX) : 0; > + val = FIELD_PREP(FMC2_BXTR_BUSTURN, val); > + clrsetbits_le32(ebi->io_base + reg, FMC2_BXTR_BUSTURN, val); > + > + return 0; > +} > + > +static int stm32_fmc2_ebi_set_data_hold(struct stm32_fmc2_ebi *ebi, > + const struct stm32_fmc2_prop *prop, > + int cs, u32 setup) > +{ > + u32 val, reg; > + int ret; > + > + ret = stm32_fmc2_ebi_get_reg(prop->reg_type, cs, ®); > + if (ret) > + return ret; > + > + if (prop->reg_type == FMC2_REG_BWTR) > + val = setup ? min_t(u32, setup - 1, FMC2_BXTR_DATAHLD_MAX) : 0; > + else > + val = min_t(u32, setup, FMC2_BXTR_DATAHLD_MAX); > + val = FIELD_PREP(FMC2_BXTR_DATAHLD, val); > + clrsetbits_le32(ebi->io_base + reg, FMC2_BXTR_DATAHLD, val); > + > + return 0; > +} > + > +static int stm32_fmc2_ebi_set_clk_period(struct stm32_fmc2_ebi *ebi, > + const struct stm32_fmc2_prop *prop, > + int cs, u32 setup) > +{ > + u32 val; > + > + val = setup ? clamp_val(setup - 1, 1, FMC2_BTR_CLKDIV_MAX) : 1; > + val = FIELD_PREP(FMC2_BTR_CLKDIV, val); > + clrsetbits_le32(ebi->io_base + FMC2_BTR(cs), FMC2_BTR_CLKDIV, val); > + > + return 0; > +} > + > +static int stm32_fmc2_ebi_set_data_latency(struct stm32_fmc2_ebi *ebi, > + const struct stm32_fmc2_prop *prop, > + int cs, u32 setup) > +{ > + u32 val; > + > + val = setup > 1 ? min_t(u32, setup - 2, FMC2_BTR_DATLAT_MAX) : 0; > + val = FIELD_PREP(FMC2_BTR_DATLAT, val); > + clrsetbits_le32(ebi->io_base + FMC2_BTR(cs), FMC2_BTR_DATLAT, val); > + > + return 0; > +} > + > +static int stm32_fmc2_ebi_set_max_low_pulse(struct stm32_fmc2_ebi *ebi, > + const struct stm32_fmc2_prop *prop, > + int cs, u32 setup) > +{ > + u32 old_val, new_val, pcscntr; > + > + if (setup < 1) > + return 0; > + > + pcscntr = readl(ebi->io_base + FMC2_PCSCNTR); > + > + /* Enable counter for the bank */ > + setbits_le32(ebi->io_base + FMC2_PCSCNTR, FMC2_PCSCNTR_CNTBEN(cs)); > + > + new_val = min_t(u32, setup - 1, FMC2_PCSCNTR_CSCOUNT_MAX); > + old_val = FIELD_GET(FMC2_PCSCNTR_CSCOUNT, pcscntr); > + if (old_val && new_val > old_val) > + /* Keep current counter value */ > + return 0; > + > + new_val = FIELD_PREP(FMC2_PCSCNTR_CSCOUNT, new_val); > + clrsetbits_le32(ebi->io_base + FMC2_PCSCNTR, > + FMC2_PCSCNTR_CSCOUNT, new_val); > + > + return 0; > +} > + > +static const struct stm32_fmc2_prop stm32_fmc2_child_props[] = { > + /* st,fmc2-ebi-cs-trans-type must be the first property */ > + { > + .name = "st,fmc2-ebi-cs-transaction-type", > + .mprop = true, > + .set = stm32_fmc2_ebi_set_trans_type, > + }, > + { > + .name = "st,fmc2-ebi-cs-cclk-enable", > + .bprop = true, > + .reg_type = FMC2_REG_BCR, > + .reg_mask = FMC2_BCR1_CCLKEN, > + .check = stm32_fmc2_ebi_check_cclk, > + .set = stm32_fmc2_ebi_set_bit_field, > + }, > + { > + .name = "st,fmc2-ebi-cs-mux-enable", > + .bprop = true, > + .reg_type = FMC2_REG_BCR, > + .reg_mask = FMC2_BCR_MUXEN, > + .check = stm32_fmc2_ebi_check_mux, > + .set = stm32_fmc2_ebi_set_bit_field, > + }, > + { > + .name = "st,fmc2-ebi-cs-buswidth", > + .reset_val = FMC2_BUSWIDTH_16, > + .set = stm32_fmc2_ebi_set_buswidth, > + }, > + { > + .name = "st,fmc2-ebi-cs-waitpol-high", > + .bprop = true, > + .reg_type = FMC2_REG_BCR, > + .reg_mask = FMC2_BCR_WAITPOL, > + .set = stm32_fmc2_ebi_set_bit_field, > + }, > + { > + .name = "st,fmc2-ebi-cs-waitcfg-enable", > + .bprop = true, > + .reg_type = FMC2_REG_BCR, > + .reg_mask = FMC2_BCR_WAITCFG, > + .check = stm32_fmc2_ebi_check_waitcfg, > + .set = stm32_fmc2_ebi_set_bit_field, > + }, > + { > + .name = "st,fmc2-ebi-cs-wait-enable", > + .bprop = true, > + .reg_type = FMC2_REG_BCR, > + .reg_mask = FMC2_BCR_WAITEN, > + .check = stm32_fmc2_ebi_check_sync_trans, > + .set = stm32_fmc2_ebi_set_bit_field, > + }, > + { > + .name = "st,fmc2-ebi-cs-asyncwait-enable", > + .bprop = true, > + .reg_type = FMC2_REG_BCR, > + .reg_mask = FMC2_BCR_ASYNCWAIT, > + .check = stm32_fmc2_ebi_check_async_trans, > + .set = stm32_fmc2_ebi_set_bit_field, > + }, > + { > + .name = "st,fmc2-ebi-cs-cpsize", > + .check = stm32_fmc2_ebi_check_cpsize, > + .set = stm32_fmc2_ebi_set_cpsize, > + }, > + { > + .name = "st,fmc2-ebi-cs-byte-lane-setup-ns", > + .calculate = stm32_fmc2_ebi_ns_to_clock_cycles, > + .set = stm32_fmc2_ebi_set_bl_setup, > + }, > + { > + .name = "st,fmc2-ebi-cs-address-setup-ns", > + .reg_type = FMC2_REG_BTR, > + .reset_val = FMC2_BXTR_ADDSET_MAX, > + .check = stm32_fmc2_ebi_check_async_trans, > + .calculate = stm32_fmc2_ebi_ns_to_clock_cycles, > + .set = stm32_fmc2_ebi_set_address_setup, > + }, > + { > + .name = "st,fmc2-ebi-cs-address-hold-ns", > + .reg_type = FMC2_REG_BTR, > + .reset_val = FMC2_BXTR_ADDHLD_MAX, > + .check = stm32_fmc2_ebi_check_address_hold, > + .calculate = stm32_fmc2_ebi_ns_to_clock_cycles, > + .set = stm32_fmc2_ebi_set_address_hold, > + }, > + { > + .name = "st,fmc2-ebi-cs-data-setup-ns", > + .reg_type = FMC2_REG_BTR, > + .reset_val = FMC2_BXTR_DATAST_MAX, > + .check = stm32_fmc2_ebi_check_async_trans, > + .calculate = stm32_fmc2_ebi_ns_to_clock_cycles, > + .set = stm32_fmc2_ebi_set_data_setup, > + }, > + { > + .name = "st,fmc2-ebi-cs-bus-turnaround-ns", > + .reg_type = FMC2_REG_BTR, > + .reset_val = FMC2_BXTR_BUSTURN_MAX + 1, > + .calculate = stm32_fmc2_ebi_ns_to_clock_cycles, > + .set = stm32_fmc2_ebi_set_bus_turnaround, > + }, > + { > + .name = "st,fmc2-ebi-cs-data-hold-ns", > + .reg_type = FMC2_REG_BTR, > + .check = stm32_fmc2_ebi_check_async_trans, > + .calculate = stm32_fmc2_ebi_ns_to_clock_cycles, > + .set = stm32_fmc2_ebi_set_data_hold, > + }, > + { > + .name = "st,fmc2-ebi-cs-clk-period-ns", > + .reset_val = FMC2_BTR_CLKDIV_MAX + 1, > + .check = stm32_fmc2_ebi_check_clk_period, > + .calculate = stm32_fmc2_ebi_ns_to_clock_cycles, > + .set = stm32_fmc2_ebi_set_clk_period, > + }, > + { > + .name = "st,fmc2-ebi-cs-data-latency-ns", > + .check = stm32_fmc2_ebi_check_sync_trans, > + .calculate = stm32_fmc2_ebi_ns_to_clk_period, > + .set = stm32_fmc2_ebi_set_data_latency, > + }, > + { > + .name = "st,fmc2-ebi-cs-write-address-setup-ns", > + .reg_type = FMC2_REG_BWTR, > + .reset_val = FMC2_BXTR_ADDSET_MAX, > + .check = stm32_fmc2_ebi_check_async_trans, > + .calculate = stm32_fmc2_ebi_ns_to_clock_cycles, > + .set = stm32_fmc2_ebi_set_address_setup, > + }, > + { > + .name = "st,fmc2-ebi-cs-write-address-hold-ns", > + .reg_type = FMC2_REG_BWTR, > + .reset_val = FMC2_BXTR_ADDHLD_MAX, > + .check = stm32_fmc2_ebi_check_address_hold, > + .calculate = stm32_fmc2_ebi_ns_to_clock_cycles, > + .set = stm32_fmc2_ebi_set_address_hold, > + }, > + { > + .name = "st,fmc2-ebi-cs-write-data-setup-ns", > + .reg_type = FMC2_REG_BWTR, > + .reset_val = FMC2_BXTR_DATAST_MAX, > + .check = stm32_fmc2_ebi_check_async_trans, > + .calculate = stm32_fmc2_ebi_ns_to_clock_cycles, > + .set = stm32_fmc2_ebi_set_data_setup, > + }, > + { > + .name = "st,fmc2-ebi-cs-write-bus-turnaround-ns", > + .reg_type = FMC2_REG_BWTR, > + .reset_val = FMC2_BXTR_BUSTURN_MAX + 1, > + .calculate = stm32_fmc2_ebi_ns_to_clock_cycles, > + .set = stm32_fmc2_ebi_set_bus_turnaround, > + }, > + { > + .name = "st,fmc2-ebi-cs-write-data-hold-ns", > + .reg_type = FMC2_REG_BWTR, > + .check = stm32_fmc2_ebi_check_async_trans, > + .calculate = stm32_fmc2_ebi_ns_to_clock_cycles, > + .set = stm32_fmc2_ebi_set_data_hold, > + }, > + { > + .name = "st,fmc2-ebi-cs-max-low-pulse-ns", > + .calculate = stm32_fmc2_ebi_ns_to_clock_cycles, > + .set = stm32_fmc2_ebi_set_max_low_pulse, > + }, > +}; > + > +static int stm32_fmc2_ebi_parse_prop(struct stm32_fmc2_ebi *ebi, > + ofnode node, > + const struct stm32_fmc2_prop *prop, > + int cs) > +{ > + u32 setup = 0; > + > + if (!prop->set) { > + pr_err("property %s is not well defined\n", prop->name); > + return -EINVAL; > + } > + > + if (prop->check && prop->check(ebi, prop, cs)) > + /* Skip this property */ > + return 0; > + > + if (prop->bprop) { > + bool bprop; > + > + bprop = ofnode_read_bool(node, prop->name); > + if (prop->mprop && !bprop) { > + pr_err("mandatory property %s not defined in the device tree\n", > + prop->name); > + return -EINVAL; > + } > + > + if (bprop) > + setup = 1; > + } else { > + u32 val; > + int ret; > + > + ret = ofnode_read_u32(node, prop->name, &val); > + if (prop->mprop && ret) { > + pr_err("mandatory property %s not defined in the device tree\n", > + prop->name); > + return ret; > + } > + > + if (ret) > + setup = prop->reset_val; > + else if (prop->calculate) > + setup = prop->calculate(ebi, cs, val); > + else > + setup = val; > + } > + > + return prop->set(ebi, prop, cs, setup); > +} > + > +static void stm32_fmc2_ebi_enable_bank(struct stm32_fmc2_ebi *ebi, int cs) > +{ > + setbits_le32(ebi->io_base + FMC2_BCR(cs), FMC2_BCR_MBKEN); > +} > + > +static void stm32_fmc2_ebi_disable_bank(struct stm32_fmc2_ebi *ebi, int cs) > +{ > + clrbits_le32(ebi->io_base + FMC2_BCR(cs), FMC2_BCR_MBKEN); > +} > + > +/* NWAIT signal can not be connected to EBI controller and NAND controller */ > +static bool stm32_fmc2_ebi_nwait_used_by_ctrls(struct stm32_fmc2_ebi *ebi) > +{ > + unsigned int cs; > + u32 bcr; > + > + for (cs = 0; cs < FMC2_MAX_EBI_CE; cs++) { > + if (!(ebi->bank_assigned & BIT(cs))) > + continue; > + > + bcr = readl(ebi->io_base + FMC2_BCR(cs)); > + if ((bcr & FMC2_BCR_WAITEN || bcr & FMC2_BCR_ASYNCWAIT) && > + ebi->bank_assigned & BIT(FMC2_NAND)) > + return true; > + } > + > + return false; > +} > + > +static void stm32_fmc2_ebi_enable(struct stm32_fmc2_ebi *ebi) > +{ > + setbits_le32(ebi->io_base + FMC2_BCR1, FMC2_BCR1_FMC2EN); > +} > + > +static int stm32_fmc2_ebi_setup_cs(struct stm32_fmc2_ebi *ebi, > + ofnode node, u32 cs) > +{ > + unsigned int i; > + int ret; > + > + stm32_fmc2_ebi_disable_bank(ebi, cs); > + > + for (i = 0; i < ARRAY_SIZE(stm32_fmc2_child_props); i++) { > + const struct stm32_fmc2_prop *p = &stm32_fmc2_child_props[i]; > + > + ret = stm32_fmc2_ebi_parse_prop(ebi, node, p, cs); > + if (ret) { > + pr_err("property %s could not be set: %d\n", > + p->name, ret); > + return ret; > + } > + } > + > + stm32_fmc2_ebi_enable_bank(ebi, cs); > + > + return 0; > +} > + > +static int stm32_fmc2_ebi_parse_dt(struct udevice *dev, > + struct stm32_fmc2_ebi *ebi) > +{ > + ofnode child; > + bool child_found = false; > + u32 bank; > + int ret; > + > + dev_for_each_subnode(child, dev) { > + ret = ofnode_read_u32(child, "reg", &bank); > + if (ret) { > + pr_err("could not retrieve reg property: %d\n", ret); > + return ret; > + } > + > + if (bank >= FMC2_MAX_BANKS) { > + pr_err("invalid reg value: %d\n", bank); > + return -EINVAL; > + } > + > + if (ebi->bank_assigned & BIT(bank)) { > + pr_err("bank already assigned: %d\n", bank); > + return -EINVAL; > + } > + > + if (bank < FMC2_MAX_EBI_CE) { > + ret = stm32_fmc2_ebi_setup_cs(ebi, child, bank); > + if (ret) { > + pr_err("setup chip select %d failed: %d\n", > + bank, ret); > + return ret; > + } > + } > + > + ebi->bank_assigned |= BIT(bank); > + child_found = true; > + } > + > + if (!child_found) { > + pr_warn("no subnodes found, disable the driver.\n"); > + return -ENODEV; > + } > + > + if (stm32_fmc2_ebi_nwait_used_by_ctrls(ebi)) { > + pr_err("NWAIT signal connected to EBI and NAND controllers\n"); > + return -EINVAL; > + } > + > + stm32_fmc2_ebi_enable(ebi); > + > + return 0; > +} > + > +static int stm32_fmc2_ebi_probe(struct udevice *dev) > +{ > + struct stm32_fmc2_ebi *ebi = dev_get_priv(dev); > + struct reset_ctl reset; > + int ret; > + > + ebi->io_base = dev_read_addr(dev); > + if (ebi->io_base == FDT_ADDR_T_NONE) > + return -EINVAL; > + > + ret = clk_get_by_index(dev, 0, &ebi->clk); > + if (ret) > + return ret; > + > + ret = clk_enable(&ebi->clk); > + if (ret) > + return ret; > + > + ret = reset_get_by_index(dev, 0, &reset); > + if (!ret) { > + reset_assert(&reset); > + udelay(2); > + reset_deassert(&reset); > + } > + > + return stm32_fmc2_ebi_parse_dt(dev, ebi); > +} > + > +static const struct udevice_id stm32_fmc2_ebi_match[] = { > + {.compatible = "st,stm32mp1-fmc2-ebi"}, > + { /* Sentinel */ } > +}; > + > +U_BOOT_DRIVER(stm32_fmc2_ebi) = { > + .name = "stm32_fmc2_ebi", > + .id = UCLASS_NOP, > + .of_match = stm32_fmc2_ebi_match, > + .probe = stm32_fmc2_ebi_probe, > + .priv_auto_alloc_size = sizeof(struct stm32_fmc2_ebi), > + .bind = dm_scan_fdt_dev, > +}; Reviewed-by: Patrice Chotard <patrice.chotard@st.com> Thanks Patrice
On 8/13/20 9:31 AM, Patrice CHOTARD wrote: > Hi Christophe > > On 7/31/20 9:53 AM, Christophe Kerello wrote: >> The driver adds the support for the STMicroelectronics FMC2 EBI controller >> found on STM32MP SOCs. >> >> Signed-off-by: Christophe Kerello <christophe.kerello@st.com> >> --- >> >> drivers/memory/Kconfig | 9 + >> drivers/memory/Makefile | 1 + >> drivers/memory/stm32-fmc2-ebi.c | 1056 +++++++++++++++++++++++++++++++++++++++ >> 3 files changed, 1066 insertions(+) >> create mode 100644 drivers/memory/stm32-fmc2-ebi.c Applied on u-boot-stm/master Thanks >> >> diff --git a/drivers/memory/Kconfig b/drivers/memory/Kconfig >> index 4fbb5aa..7271892 100644 >> --- a/drivers/memory/Kconfig >> +++ b/drivers/memory/Kconfig >> @@ -4,6 +4,15 @@ >> >> menu "Memory Controller drivers" >> >> +config STM32_FMC2_EBI >> + bool "Support for FMC2 External Bus Interface on STM32MP SoCs" >> + depends on ARCH_STM32MP >> + help >> + Select this option to enable the STM32 FMC2 External Bus Interface >> + controller. This driver configures the transactions with external >> + devices (like SRAM, ethernet adapters, FPGAs, LCD displays, ...) on >> + SOCs containing the FMC2 External Bus Interface. >> + >> config TI_AEMIF >> tristate "Texas Instruments AEMIF driver" >> depends on ARCH_KEYSTONE >> diff --git a/drivers/memory/Makefile b/drivers/memory/Makefile >> index 238add0..fec52ef 100644 >> --- a/drivers/memory/Makefile >> +++ b/drivers/memory/Makefile >> @@ -1,2 +1,3 @@ >> >> +obj-$(CONFIG_STM32_FMC2_EBI) += stm32-fmc2-ebi.o >> obj-$(CONFIG_TI_AEMIF) += ti-aemif.o >> diff --git a/drivers/memory/stm32-fmc2-ebi.c b/drivers/memory/stm32-fmc2-ebi.c >> new file mode 100644 >> index 0000000..d887a1e >> --- /dev/null >> +++ b/drivers/memory/stm32-fmc2-ebi.c >> @@ -0,0 +1,1056 @@ >> +// SPDX-License-Identifier: GPL-2.0+ OR BSD-3-Clause >> +/* >> + * Copyright (C) STMicroelectronics 2020 >> + */ >> + >> +#include <common.h> >> +#include <clk.h> >> +#include <dm.h> >> +#include <reset.h> >> +#include <linux/bitfield.h> >> +#include <linux/err.h> >> +#include <linux/iopoll.h> >> +#include <linux/ioport.h> >> + >> +/* FMC2 Controller Registers */ >> +#define FMC2_BCR1 0x0 >> +#define FMC2_BTR1 0x4 >> +#define FMC2_BCR(x) ((x) * 0x8 + FMC2_BCR1) >> +#define FMC2_BTR(x) ((x) * 0x8 + FMC2_BTR1) >> +#define FMC2_PCSCNTR 0x20 >> +#define FMC2_BWTR1 0x104 >> +#define FMC2_BWTR(x) ((x) * 0x8 + FMC2_BWTR1) >> + >> +/* Register: FMC2_BCR1 */ >> +#define FMC2_BCR1_CCLKEN BIT(20) >> +#define FMC2_BCR1_FMC2EN BIT(31) >> + >> +/* Register: FMC2_BCRx */ >> +#define FMC2_BCR_MBKEN BIT(0) >> +#define FMC2_BCR_MUXEN BIT(1) >> +#define FMC2_BCR_MTYP GENMASK(3, 2) >> +#define FMC2_BCR_MWID GENMASK(5, 4) >> +#define FMC2_BCR_FACCEN BIT(6) >> +#define FMC2_BCR_BURSTEN BIT(8) >> +#define FMC2_BCR_WAITPOL BIT(9) >> +#define FMC2_BCR_WAITCFG BIT(11) >> +#define FMC2_BCR_WREN BIT(12) >> +#define FMC2_BCR_WAITEN BIT(13) >> +#define FMC2_BCR_EXTMOD BIT(14) >> +#define FMC2_BCR_ASYNCWAIT BIT(15) >> +#define FMC2_BCR_CPSIZE GENMASK(18, 16) >> +#define FMC2_BCR_CBURSTRW BIT(19) >> +#define FMC2_BCR_NBLSET GENMASK(23, 22) >> + >> +/* Register: FMC2_BTRx/FMC2_BWTRx */ >> +#define FMC2_BXTR_ADDSET GENMASK(3, 0) >> +#define FMC2_BXTR_ADDHLD GENMASK(7, 4) >> +#define FMC2_BXTR_DATAST GENMASK(15, 8) >> +#define FMC2_BXTR_BUSTURN GENMASK(19, 16) >> +#define FMC2_BTR_CLKDIV GENMASK(23, 20) >> +#define FMC2_BTR_DATLAT GENMASK(27, 24) >> +#define FMC2_BXTR_ACCMOD GENMASK(29, 28) >> +#define FMC2_BXTR_DATAHLD GENMASK(31, 30) >> + >> +/* Register: FMC2_PCSCNTR */ >> +#define FMC2_PCSCNTR_CSCOUNT GENMASK(15, 0) >> +#define FMC2_PCSCNTR_CNTBEN(x) BIT((x) + 16) >> + >> +#define FMC2_MAX_EBI_CE 4 >> +#define FMC2_MAX_BANKS 5 >> + >> +#define FMC2_BCR_CPSIZE_0 0x0 >> +#define FMC2_BCR_CPSIZE_128 0x1 >> +#define FMC2_BCR_CPSIZE_256 0x2 >> +#define FMC2_BCR_CPSIZE_512 0x3 >> +#define FMC2_BCR_CPSIZE_1024 0x4 >> + >> +#define FMC2_BCR_MWID_8 0x0 >> +#define FMC2_BCR_MWID_16 0x1 >> + >> +#define FMC2_BCR_MTYP_SRAM 0x0 >> +#define FMC2_BCR_MTYP_PSRAM 0x1 >> +#define FMC2_BCR_MTYP_NOR 0x2 >> + >> +#define FMC2_BXTR_EXTMOD_A 0x0 >> +#define FMC2_BXTR_EXTMOD_B 0x1 >> +#define FMC2_BXTR_EXTMOD_C 0x2 >> +#define FMC2_BXTR_EXTMOD_D 0x3 >> + >> +#define FMC2_BCR_NBLSET_MAX 0x3 >> +#define FMC2_BXTR_ADDSET_MAX 0xf >> +#define FMC2_BXTR_ADDHLD_MAX 0xf >> +#define FMC2_BXTR_DATAST_MAX 0xff >> +#define FMC2_BXTR_BUSTURN_MAX 0xf >> +#define FMC2_BXTR_DATAHLD_MAX 0x3 >> +#define FMC2_BTR_CLKDIV_MAX 0xf >> +#define FMC2_BTR_DATLAT_MAX 0xf >> +#define FMC2_PCSCNTR_CSCOUNT_MAX 0xff >> + >> +#define FMC2_NSEC_PER_SEC 1000000000L >> + >> +enum stm32_fmc2_ebi_bank { >> + FMC2_EBI1 = 0, >> + FMC2_EBI2, >> + FMC2_EBI3, >> + FMC2_EBI4, >> + FMC2_NAND >> +}; >> + >> +enum stm32_fmc2_ebi_register_type { >> + FMC2_REG_BCR = 1, >> + FMC2_REG_BTR, >> + FMC2_REG_BWTR, >> + FMC2_REG_PCSCNTR >> +}; >> + >> +enum stm32_fmc2_ebi_transaction_type { >> + FMC2_ASYNC_MODE_1_SRAM = 0, >> + FMC2_ASYNC_MODE_1_PSRAM, >> + FMC2_ASYNC_MODE_A_SRAM, >> + FMC2_ASYNC_MODE_A_PSRAM, >> + FMC2_ASYNC_MODE_2_NOR, >> + FMC2_ASYNC_MODE_B_NOR, >> + FMC2_ASYNC_MODE_C_NOR, >> + FMC2_ASYNC_MODE_D_NOR, >> + FMC2_SYNC_READ_SYNC_WRITE_PSRAM, >> + FMC2_SYNC_READ_ASYNC_WRITE_PSRAM, >> + FMC2_SYNC_READ_SYNC_WRITE_NOR, >> + FMC2_SYNC_READ_ASYNC_WRITE_NOR >> +}; >> + >> +enum stm32_fmc2_ebi_buswidth { >> + FMC2_BUSWIDTH_8 = 8, >> + FMC2_BUSWIDTH_16 = 16 >> +}; >> + >> +enum stm32_fmc2_ebi_cpsize { >> + FMC2_CPSIZE_0 = 0, >> + FMC2_CPSIZE_128 = 128, >> + FMC2_CPSIZE_256 = 256, >> + FMC2_CPSIZE_512 = 512, >> + FMC2_CPSIZE_1024 = 1024 >> +}; >> + >> +struct stm32_fmc2_ebi { >> + struct clk clk; >> + fdt_addr_t io_base; >> + u8 bank_assigned; >> +}; >> + >> +/* >> + * struct stm32_fmc2_prop - STM32 FMC2 EBI property >> + * @name: the device tree binding name of the property >> + * @bprop: indicate that it is a boolean property >> + * @mprop: indicate that it is a mandatory property >> + * @reg_type: the register that have to be modified >> + * @reg_mask: the bit that have to be modified in the selected register >> + * in case of it is a boolean property >> + * @reset_val: the default value that have to be set in case the property >> + * has not been defined in the device tree >> + * @check: this callback ckecks that the property is compliant with the >> + * transaction type selected >> + * @calculate: this callback is called to calculate for exemple a timing >> + * set in nanoseconds in the device tree in clock cycles or in >> + * clock period >> + * @set: this callback applies the values in the registers >> + */ >> +struct stm32_fmc2_prop { >> + const char *name; >> + bool bprop; >> + bool mprop; >> + int reg_type; >> + u32 reg_mask; >> + u32 reset_val; >> + int (*check)(struct stm32_fmc2_ebi *ebi, >> + const struct stm32_fmc2_prop *prop, int cs); >> + u32 (*calculate)(struct stm32_fmc2_ebi *ebi, int cs, u32 setup); >> + int (*set)(struct stm32_fmc2_ebi *ebi, >> + const struct stm32_fmc2_prop *prop, >> + int cs, u32 setup); >> +}; >> + >> +static int stm32_fmc2_ebi_check_mux(struct stm32_fmc2_ebi *ebi, >> + const struct stm32_fmc2_prop *prop, >> + int cs) >> +{ >> + u32 bcr = readl(ebi->io_base + FMC2_BCR(cs)); >> + >> + if (bcr & FMC2_BCR_MTYP) >> + return 0; >> + >> + return -EINVAL; >> +} >> + >> +static int stm32_fmc2_ebi_check_waitcfg(struct stm32_fmc2_ebi *ebi, >> + const struct stm32_fmc2_prop *prop, >> + int cs) >> +{ >> + u32 bcr = readl(ebi->io_base + FMC2_BCR(cs)); >> + u32 val = FIELD_PREP(FMC2_BCR_MTYP, FMC2_BCR_MTYP_NOR); >> + >> + if ((bcr & FMC2_BCR_MTYP) == val && bcr & FMC2_BCR_BURSTEN) >> + return 0; >> + >> + return -EINVAL; >> +} >> + >> +static int stm32_fmc2_ebi_check_sync_trans(struct stm32_fmc2_ebi *ebi, >> + const struct stm32_fmc2_prop *prop, >> + int cs) >> +{ >> + u32 bcr = readl(ebi->io_base + FMC2_BCR(cs)); >> + >> + if (bcr & FMC2_BCR_BURSTEN) >> + return 0; >> + >> + return -EINVAL; >> +} >> + >> +static int stm32_fmc2_ebi_check_async_trans(struct stm32_fmc2_ebi *ebi, >> + const struct stm32_fmc2_prop *prop, >> + int cs) >> +{ >> + u32 bcr = readl(ebi->io_base + FMC2_BCR(cs)); >> + >> + if (!(bcr & FMC2_BCR_BURSTEN) || !(bcr & FMC2_BCR_CBURSTRW)) >> + return 0; >> + >> + return -EINVAL; >> +} >> + >> +static int stm32_fmc2_ebi_check_cpsize(struct stm32_fmc2_ebi *ebi, >> + const struct stm32_fmc2_prop *prop, >> + int cs) >> +{ >> + u32 bcr = readl(ebi->io_base + FMC2_BCR(cs)); >> + u32 val = FIELD_PREP(FMC2_BCR_MTYP, FMC2_BCR_MTYP_PSRAM); >> + >> + if ((bcr & FMC2_BCR_MTYP) == val && bcr & FMC2_BCR_BURSTEN) >> + return 0; >> + >> + return -EINVAL; >> +} >> + >> +static int stm32_fmc2_ebi_check_address_hold(struct stm32_fmc2_ebi *ebi, >> + const struct stm32_fmc2_prop *prop, >> + int cs) >> +{ >> + u32 bcr = readl(ebi->io_base + FMC2_BCR(cs)); >> + u32 bxtr = prop->reg_type == FMC2_REG_BWTR ? >> + readl(ebi->io_base + FMC2_BWTR(cs)) : >> + readl(ebi->io_base + FMC2_BTR(cs)); >> + u32 val = FIELD_PREP(FMC2_BXTR_ACCMOD, FMC2_BXTR_EXTMOD_D); >> + >> + if ((!(bcr & FMC2_BCR_BURSTEN) || !(bcr & FMC2_BCR_CBURSTRW)) && >> + ((bxtr & FMC2_BXTR_ACCMOD) == val || bcr & FMC2_BCR_MUXEN)) >> + return 0; >> + >> + return -EINVAL; >> +} >> + >> +static int stm32_fmc2_ebi_check_clk_period(struct stm32_fmc2_ebi *ebi, >> + const struct stm32_fmc2_prop *prop, >> + int cs) >> +{ >> + u32 bcr = readl(ebi->io_base + FMC2_BCR(cs)); >> + u32 bcr1 = cs ? readl(ebi->io_base + FMC2_BCR1) : bcr; >> + >> + if (bcr & FMC2_BCR_BURSTEN && (!cs || !(bcr1 & FMC2_BCR1_CCLKEN))) >> + return 0; >> + >> + return -EINVAL; >> +} >> + >> +static int stm32_fmc2_ebi_check_cclk(struct stm32_fmc2_ebi *ebi, >> + const struct stm32_fmc2_prop *prop, >> + int cs) >> +{ >> + if (cs) >> + return -EINVAL; >> + >> + return stm32_fmc2_ebi_check_sync_trans(ebi, prop, cs); >> +} >> + >> +static u32 stm32_fmc2_ebi_ns_to_clock_cycles(struct stm32_fmc2_ebi *ebi, >> + int cs, u32 setup) >> +{ >> + unsigned long hclk = clk_get_rate(&ebi->clk); >> + unsigned long hclkp = FMC2_NSEC_PER_SEC / (hclk / 1000); >> + >> + return DIV_ROUND_UP(setup * 1000, hclkp); >> +} >> + >> +static u32 stm32_fmc2_ebi_ns_to_clk_period(struct stm32_fmc2_ebi *ebi, >> + int cs, u32 setup) >> +{ >> + u32 nb_clk_cycles = stm32_fmc2_ebi_ns_to_clock_cycles(ebi, cs, setup); >> + u32 bcr = readl(ebi->io_base + FMC2_BCR1); >> + u32 btr = bcr & FMC2_BCR1_CCLKEN || !cs ? >> + readl(ebi->io_base + FMC2_BTR1) : >> + readl(ebi->io_base + FMC2_BTR(cs)); >> + u32 clk_period = FIELD_GET(FMC2_BTR_CLKDIV, btr) + 1; >> + >> + return DIV_ROUND_UP(nb_clk_cycles, clk_period); >> +} >> + >> +static int stm32_fmc2_ebi_get_reg(int reg_type, int cs, u32 *reg) >> +{ >> + switch (reg_type) { >> + case FMC2_REG_BCR: >> + *reg = FMC2_BCR(cs); >> + break; >> + case FMC2_REG_BTR: >> + *reg = FMC2_BTR(cs); >> + break; >> + case FMC2_REG_BWTR: >> + *reg = FMC2_BWTR(cs); >> + break; >> + case FMC2_REG_PCSCNTR: >> + *reg = FMC2_PCSCNTR; >> + break; >> + default: >> + return -EINVAL; >> + } >> + >> + return 0; >> +} >> + >> +static int stm32_fmc2_ebi_set_bit_field(struct stm32_fmc2_ebi *ebi, >> + const struct stm32_fmc2_prop *prop, >> + int cs, u32 setup) >> +{ >> + u32 reg; >> + int ret; >> + >> + ret = stm32_fmc2_ebi_get_reg(prop->reg_type, cs, ®); >> + if (ret) >> + return ret; >> + >> + clrsetbits_le32(ebi->io_base + reg, prop->reg_mask, >> + setup ? prop->reg_mask : 0); >> + >> + return 0; >> +} >> + >> +static int stm32_fmc2_ebi_set_trans_type(struct stm32_fmc2_ebi *ebi, >> + const struct stm32_fmc2_prop *prop, >> + int cs, u32 setup) >> +{ >> + u32 bcr_mask, bcr = FMC2_BCR_WREN; >> + u32 btr_mask, btr = 0; >> + u32 bwtr_mask, bwtr = 0; >> + >> + bwtr_mask = FMC2_BXTR_ACCMOD; >> + btr_mask = FMC2_BXTR_ACCMOD; >> + bcr_mask = FMC2_BCR_MUXEN | FMC2_BCR_MTYP | FMC2_BCR_FACCEN | >> + FMC2_BCR_WREN | FMC2_BCR_WAITEN | FMC2_BCR_BURSTEN | >> + FMC2_BCR_EXTMOD | FMC2_BCR_CBURSTRW; >> + >> + switch (setup) { >> + case FMC2_ASYNC_MODE_1_SRAM: >> + bcr |= FIELD_PREP(FMC2_BCR_MTYP, FMC2_BCR_MTYP_SRAM); >> + /* >> + * MUXEN = 0, MTYP = 0, FACCEN = 0, BURSTEN = 0, WAITEN = 0, >> + * WREN = 1, EXTMOD = 0, CBURSTRW = 0, ACCMOD = 0 >> + */ >> + break; >> + case FMC2_ASYNC_MODE_1_PSRAM: >> + /* >> + * MUXEN = 0, MTYP = 1, FACCEN = 0, BURSTEN = 0, WAITEN = 0, >> + * WREN = 1, EXTMOD = 0, CBURSTRW = 0, ACCMOD = 0 >> + */ >> + bcr |= FIELD_PREP(FMC2_BCR_MTYP, FMC2_BCR_MTYP_PSRAM); >> + break; >> + case FMC2_ASYNC_MODE_A_SRAM: >> + /* >> + * MUXEN = 0, MTYP = 0, FACCEN = 0, BURSTEN = 0, WAITEN = 0, >> + * WREN = 1, EXTMOD = 1, CBURSTRW = 0, ACCMOD = 0 >> + */ >> + bcr |= FIELD_PREP(FMC2_BCR_MTYP, FMC2_BCR_MTYP_SRAM); >> + bcr |= FMC2_BCR_EXTMOD; >> + btr |= FIELD_PREP(FMC2_BXTR_ACCMOD, FMC2_BXTR_EXTMOD_A); >> + bwtr |= FIELD_PREP(FMC2_BXTR_ACCMOD, FMC2_BXTR_EXTMOD_A); >> + break; >> + case FMC2_ASYNC_MODE_A_PSRAM: >> + /* >> + * MUXEN = 0, MTYP = 1, FACCEN = 0, BURSTEN = 0, WAITEN = 0, >> + * WREN = 1, EXTMOD = 1, CBURSTRW = 0, ACCMOD = 0 >> + */ >> + bcr |= FIELD_PREP(FMC2_BCR_MTYP, FMC2_BCR_MTYP_PSRAM); >> + bcr |= FMC2_BCR_EXTMOD; >> + btr |= FIELD_PREP(FMC2_BXTR_ACCMOD, FMC2_BXTR_EXTMOD_A); >> + bwtr |= FIELD_PREP(FMC2_BXTR_ACCMOD, FMC2_BXTR_EXTMOD_A); >> + break; >> + case FMC2_ASYNC_MODE_2_NOR: >> + /* >> + * MUXEN = 0, MTYP = 2, FACCEN = 1, BURSTEN = 0, WAITEN = 0, >> + * WREN = 1, EXTMOD = 0, CBURSTRW = 0, ACCMOD = 0 >> + */ >> + bcr |= FIELD_PREP(FMC2_BCR_MTYP, FMC2_BCR_MTYP_NOR); >> + bcr |= FMC2_BCR_FACCEN; >> + break; >> + case FMC2_ASYNC_MODE_B_NOR: >> + /* >> + * MUXEN = 0, MTYP = 2, FACCEN = 1, BURSTEN = 0, WAITEN = 0, >> + * WREN = 1, EXTMOD = 1, CBURSTRW = 0, ACCMOD = 1 >> + */ >> + bcr |= FIELD_PREP(FMC2_BCR_MTYP, FMC2_BCR_MTYP_NOR); >> + bcr |= FMC2_BCR_FACCEN | FMC2_BCR_EXTMOD; >> + btr |= FIELD_PREP(FMC2_BXTR_ACCMOD, FMC2_BXTR_EXTMOD_B); >> + bwtr |= FIELD_PREP(FMC2_BXTR_ACCMOD, FMC2_BXTR_EXTMOD_B); >> + break; >> + case FMC2_ASYNC_MODE_C_NOR: >> + /* >> + * MUXEN = 0, MTYP = 2, FACCEN = 1, BURSTEN = 0, WAITEN = 0, >> + * WREN = 1, EXTMOD = 1, CBURSTRW = 0, ACCMOD = 2 >> + */ >> + bcr |= FIELD_PREP(FMC2_BCR_MTYP, FMC2_BCR_MTYP_NOR); >> + bcr |= FMC2_BCR_FACCEN | FMC2_BCR_EXTMOD; >> + btr |= FIELD_PREP(FMC2_BXTR_ACCMOD, FMC2_BXTR_EXTMOD_C); >> + bwtr |= FIELD_PREP(FMC2_BXTR_ACCMOD, FMC2_BXTR_EXTMOD_C); >> + break; >> + case FMC2_ASYNC_MODE_D_NOR: >> + /* >> + * MUXEN = 0, MTYP = 2, FACCEN = 1, BURSTEN = 0, WAITEN = 0, >> + * WREN = 1, EXTMOD = 1, CBURSTRW = 0, ACCMOD = 3 >> + */ >> + bcr |= FIELD_PREP(FMC2_BCR_MTYP, FMC2_BCR_MTYP_NOR); >> + bcr |= FMC2_BCR_FACCEN | FMC2_BCR_EXTMOD; >> + btr |= FIELD_PREP(FMC2_BXTR_ACCMOD, FMC2_BXTR_EXTMOD_D); >> + bwtr |= FIELD_PREP(FMC2_BXTR_ACCMOD, FMC2_BXTR_EXTMOD_D); >> + break; >> + case FMC2_SYNC_READ_SYNC_WRITE_PSRAM: >> + /* >> + * MUXEN = 0, MTYP = 1, FACCEN = 0, BURSTEN = 1, WAITEN = 0, >> + * WREN = 1, EXTMOD = 0, CBURSTRW = 1, ACCMOD = 0 >> + */ >> + bcr |= FIELD_PREP(FMC2_BCR_MTYP, FMC2_BCR_MTYP_PSRAM); >> + bcr |= FMC2_BCR_BURSTEN | FMC2_BCR_CBURSTRW; >> + break; >> + case FMC2_SYNC_READ_ASYNC_WRITE_PSRAM: >> + /* >> + * MUXEN = 0, MTYP = 1, FACCEN = 0, BURSTEN = 1, WAITEN = 0, >> + * WREN = 1, EXTMOD = 0, CBURSTRW = 0, ACCMOD = 0 >> + */ >> + bcr |= FIELD_PREP(FMC2_BCR_MTYP, FMC2_BCR_MTYP_PSRAM); >> + bcr |= FMC2_BCR_BURSTEN; >> + break; >> + case FMC2_SYNC_READ_SYNC_WRITE_NOR: >> + /* >> + * MUXEN = 0, MTYP = 2, FACCEN = 1, BURSTEN = 1, WAITEN = 0, >> + * WREN = 1, EXTMOD = 0, CBURSTRW = 1, ACCMOD = 0 >> + */ >> + bcr |= FIELD_PREP(FMC2_BCR_MTYP, FMC2_BCR_MTYP_NOR); >> + bcr |= FMC2_BCR_FACCEN | FMC2_BCR_BURSTEN | FMC2_BCR_CBURSTRW; >> + break; >> + case FMC2_SYNC_READ_ASYNC_WRITE_NOR: >> + /* >> + * MUXEN = 0, MTYP = 2, FACCEN = 1, BURSTEN = 1, WAITEN = 0, >> + * WREN = 1, EXTMOD = 0, CBURSTRW = 0, ACCMOD = 0 >> + */ >> + bcr |= FIELD_PREP(FMC2_BCR_MTYP, FMC2_BCR_MTYP_NOR); >> + bcr |= FMC2_BCR_FACCEN | FMC2_BCR_BURSTEN; >> + break; >> + default: >> + /* Type of transaction not supported */ >> + return -EINVAL; >> + } >> + >> + if (bcr & FMC2_BCR_EXTMOD) >> + clrsetbits_le32(ebi->io_base + FMC2_BWTR(cs), >> + bwtr_mask, bwtr); >> + clrsetbits_le32(ebi->io_base + FMC2_BTR(cs), btr_mask, btr); >> + clrsetbits_le32(ebi->io_base + FMC2_BCR(cs), bcr_mask, bcr); >> + >> + return 0; >> +} >> + >> +static int stm32_fmc2_ebi_set_buswidth(struct stm32_fmc2_ebi *ebi, >> + const struct stm32_fmc2_prop *prop, >> + int cs, u32 setup) >> +{ >> + u32 val; >> + >> + switch (setup) { >> + case FMC2_BUSWIDTH_8: >> + val = FIELD_PREP(FMC2_BCR_MWID, FMC2_BCR_MWID_8); >> + break; >> + case FMC2_BUSWIDTH_16: >> + val = FIELD_PREP(FMC2_BCR_MWID, FMC2_BCR_MWID_16); >> + break; >> + default: >> + /* Buswidth not supported */ >> + return -EINVAL; >> + } >> + >> + clrsetbits_le32(ebi->io_base + FMC2_BCR(cs), FMC2_BCR_MWID, val); >> + >> + return 0; >> +} >> + >> +static int stm32_fmc2_ebi_set_cpsize(struct stm32_fmc2_ebi *ebi, >> + const struct stm32_fmc2_prop *prop, >> + int cs, u32 setup) >> +{ >> + u32 val; >> + >> + switch (setup) { >> + case FMC2_CPSIZE_0: >> + val = FIELD_PREP(FMC2_BCR_CPSIZE, FMC2_BCR_CPSIZE_0); >> + break; >> + case FMC2_CPSIZE_128: >> + val = FIELD_PREP(FMC2_BCR_CPSIZE, FMC2_BCR_CPSIZE_128); >> + break; >> + case FMC2_CPSIZE_256: >> + val = FIELD_PREP(FMC2_BCR_CPSIZE, FMC2_BCR_CPSIZE_256); >> + break; >> + case FMC2_CPSIZE_512: >> + val = FIELD_PREP(FMC2_BCR_CPSIZE, FMC2_BCR_CPSIZE_512); >> + break; >> + case FMC2_CPSIZE_1024: >> + val = FIELD_PREP(FMC2_BCR_CPSIZE, FMC2_BCR_CPSIZE_1024); >> + break; >> + default: >> + /* Cpsize not supported */ >> + return -EINVAL; >> + } >> + >> + clrsetbits_le32(ebi->io_base + FMC2_BCR(cs), FMC2_BCR_CPSIZE, val); >> + >> + return 0; >> +} >> + >> +static int stm32_fmc2_ebi_set_bl_setup(struct stm32_fmc2_ebi *ebi, >> + const struct stm32_fmc2_prop *prop, >> + int cs, u32 setup) >> +{ >> + u32 val; >> + >> + val = min_t(u32, setup, FMC2_BCR_NBLSET_MAX); >> + val = FIELD_PREP(FMC2_BCR_NBLSET, val); >> + clrsetbits_le32(ebi->io_base + FMC2_BCR(cs), FMC2_BCR_NBLSET, val); >> + >> + return 0; >> +} >> + >> +static int stm32_fmc2_ebi_set_address_setup(struct stm32_fmc2_ebi *ebi, >> + const struct stm32_fmc2_prop *prop, >> + int cs, u32 setup) >> +{ >> + u32 bcr = readl(ebi->io_base + FMC2_BCR(cs)); >> + u32 bxtr = prop->reg_type == FMC2_REG_BWTR ? >> + readl(ebi->io_base + FMC2_BWTR(cs)) : >> + readl(ebi->io_base + FMC2_BTR(cs)); >> + u32 reg, val = FIELD_PREP(FMC2_BXTR_ACCMOD, FMC2_BXTR_EXTMOD_D); >> + int ret; >> + >> + ret = stm32_fmc2_ebi_get_reg(prop->reg_type, cs, ®); >> + if (ret) >> + return ret; >> + >> + if ((bxtr & FMC2_BXTR_ACCMOD) == val || bcr & FMC2_BCR_MUXEN) >> + val = clamp_val(setup, 1, FMC2_BXTR_ADDSET_MAX); >> + else >> + val = min_t(u32, setup, FMC2_BXTR_ADDSET_MAX); >> + val = FIELD_PREP(FMC2_BXTR_ADDSET, val); >> + clrsetbits_le32(ebi->io_base + reg, FMC2_BXTR_ADDSET, val); >> + >> + return 0; >> +} >> + >> +static int stm32_fmc2_ebi_set_address_hold(struct stm32_fmc2_ebi *ebi, >> + const struct stm32_fmc2_prop *prop, >> + int cs, u32 setup) >> +{ >> + u32 val, reg; >> + int ret; >> + >> + ret = stm32_fmc2_ebi_get_reg(prop->reg_type, cs, ®); >> + if (ret) >> + return ret; >> + >> + val = clamp_val(setup, 1, FMC2_BXTR_ADDHLD_MAX); >> + val = FIELD_PREP(FMC2_BXTR_ADDHLD, val); >> + clrsetbits_le32(ebi->io_base + reg, FMC2_BXTR_ADDHLD, val); >> + >> + return 0; >> +} >> + >> +static int stm32_fmc2_ebi_set_data_setup(struct stm32_fmc2_ebi *ebi, >> + const struct stm32_fmc2_prop *prop, >> + int cs, u32 setup) >> +{ >> + u32 val, reg; >> + int ret; >> + >> + ret = stm32_fmc2_ebi_get_reg(prop->reg_type, cs, ®); >> + if (ret) >> + return ret; >> + >> + val = clamp_val(setup, 1, FMC2_BXTR_DATAST_MAX); >> + val = FIELD_PREP(FMC2_BXTR_DATAST, val); >> + clrsetbits_le32(ebi->io_base + reg, FMC2_BXTR_DATAST, val); >> + >> + return 0; >> +} >> + >> +static int stm32_fmc2_ebi_set_bus_turnaround(struct stm32_fmc2_ebi *ebi, >> + const struct stm32_fmc2_prop *prop, >> + int cs, u32 setup) >> +{ >> + u32 val, reg; >> + int ret; >> + >> + ret = stm32_fmc2_ebi_get_reg(prop->reg_type, cs, ®); >> + if (ret) >> + return ret; >> + >> + val = setup ? min_t(u32, setup - 1, FMC2_BXTR_BUSTURN_MAX) : 0; >> + val = FIELD_PREP(FMC2_BXTR_BUSTURN, val); >> + clrsetbits_le32(ebi->io_base + reg, FMC2_BXTR_BUSTURN, val); >> + >> + return 0; >> +} >> + >> +static int stm32_fmc2_ebi_set_data_hold(struct stm32_fmc2_ebi *ebi, >> + const struct stm32_fmc2_prop *prop, >> + int cs, u32 setup) >> +{ >> + u32 val, reg; >> + int ret; >> + >> + ret = stm32_fmc2_ebi_get_reg(prop->reg_type, cs, ®); >> + if (ret) >> + return ret; >> + >> + if (prop->reg_type == FMC2_REG_BWTR) >> + val = setup ? min_t(u32, setup - 1, FMC2_BXTR_DATAHLD_MAX) : 0; >> + else >> + val = min_t(u32, setup, FMC2_BXTR_DATAHLD_MAX); >> + val = FIELD_PREP(FMC2_BXTR_DATAHLD, val); >> + clrsetbits_le32(ebi->io_base + reg, FMC2_BXTR_DATAHLD, val); >> + >> + return 0; >> +} >> + >> +static int stm32_fmc2_ebi_set_clk_period(struct stm32_fmc2_ebi *ebi, >> + const struct stm32_fmc2_prop *prop, >> + int cs, u32 setup) >> +{ >> + u32 val; >> + >> + val = setup ? clamp_val(setup - 1, 1, FMC2_BTR_CLKDIV_MAX) : 1; >> + val = FIELD_PREP(FMC2_BTR_CLKDIV, val); >> + clrsetbits_le32(ebi->io_base + FMC2_BTR(cs), FMC2_BTR_CLKDIV, val); >> + >> + return 0; >> +} >> + >> +static int stm32_fmc2_ebi_set_data_latency(struct stm32_fmc2_ebi *ebi, >> + const struct stm32_fmc2_prop *prop, >> + int cs, u32 setup) >> +{ >> + u32 val; >> + >> + val = setup > 1 ? min_t(u32, setup - 2, FMC2_BTR_DATLAT_MAX) : 0; >> + val = FIELD_PREP(FMC2_BTR_DATLAT, val); >> + clrsetbits_le32(ebi->io_base + FMC2_BTR(cs), FMC2_BTR_DATLAT, val); >> + >> + return 0; >> +} >> + >> +static int stm32_fmc2_ebi_set_max_low_pulse(struct stm32_fmc2_ebi *ebi, >> + const struct stm32_fmc2_prop *prop, >> + int cs, u32 setup) >> +{ >> + u32 old_val, new_val, pcscntr; >> + >> + if (setup < 1) >> + return 0; >> + >> + pcscntr = readl(ebi->io_base + FMC2_PCSCNTR); >> + >> + /* Enable counter for the bank */ >> + setbits_le32(ebi->io_base + FMC2_PCSCNTR, FMC2_PCSCNTR_CNTBEN(cs)); >> + >> + new_val = min_t(u32, setup - 1, FMC2_PCSCNTR_CSCOUNT_MAX); >> + old_val = FIELD_GET(FMC2_PCSCNTR_CSCOUNT, pcscntr); >> + if (old_val && new_val > old_val) >> + /* Keep current counter value */ >> + return 0; >> + >> + new_val = FIELD_PREP(FMC2_PCSCNTR_CSCOUNT, new_val); >> + clrsetbits_le32(ebi->io_base + FMC2_PCSCNTR, >> + FMC2_PCSCNTR_CSCOUNT, new_val); >> + >> + return 0; >> +} >> + >> +static const struct stm32_fmc2_prop stm32_fmc2_child_props[] = { >> + /* st,fmc2-ebi-cs-trans-type must be the first property */ >> + { >> + .name = "st,fmc2-ebi-cs-transaction-type", >> + .mprop = true, >> + .set = stm32_fmc2_ebi_set_trans_type, >> + }, >> + { >> + .name = "st,fmc2-ebi-cs-cclk-enable", >> + .bprop = true, >> + .reg_type = FMC2_REG_BCR, >> + .reg_mask = FMC2_BCR1_CCLKEN, >> + .check = stm32_fmc2_ebi_check_cclk, >> + .set = stm32_fmc2_ebi_set_bit_field, >> + }, >> + { >> + .name = "st,fmc2-ebi-cs-mux-enable", >> + .bprop = true, >> + .reg_type = FMC2_REG_BCR, >> + .reg_mask = FMC2_BCR_MUXEN, >> + .check = stm32_fmc2_ebi_check_mux, >> + .set = stm32_fmc2_ebi_set_bit_field, >> + }, >> + { >> + .name = "st,fmc2-ebi-cs-buswidth", >> + .reset_val = FMC2_BUSWIDTH_16, >> + .set = stm32_fmc2_ebi_set_buswidth, >> + }, >> + { >> + .name = "st,fmc2-ebi-cs-waitpol-high", >> + .bprop = true, >> + .reg_type = FMC2_REG_BCR, >> + .reg_mask = FMC2_BCR_WAITPOL, >> + .set = stm32_fmc2_ebi_set_bit_field, >> + }, >> + { >> + .name = "st,fmc2-ebi-cs-waitcfg-enable", >> + .bprop = true, >> + .reg_type = FMC2_REG_BCR, >> + .reg_mask = FMC2_BCR_WAITCFG, >> + .check = stm32_fmc2_ebi_check_waitcfg, >> + .set = stm32_fmc2_ebi_set_bit_field, >> + }, >> + { >> + .name = "st,fmc2-ebi-cs-wait-enable", >> + .bprop = true, >> + .reg_type = FMC2_REG_BCR, >> + .reg_mask = FMC2_BCR_WAITEN, >> + .check = stm32_fmc2_ebi_check_sync_trans, >> + .set = stm32_fmc2_ebi_set_bit_field, >> + }, >> + { >> + .name = "st,fmc2-ebi-cs-asyncwait-enable", >> + .bprop = true, >> + .reg_type = FMC2_REG_BCR, >> + .reg_mask = FMC2_BCR_ASYNCWAIT, >> + .check = stm32_fmc2_ebi_check_async_trans, >> + .set = stm32_fmc2_ebi_set_bit_field, >> + }, >> + { >> + .name = "st,fmc2-ebi-cs-cpsize", >> + .check = stm32_fmc2_ebi_check_cpsize, >> + .set = stm32_fmc2_ebi_set_cpsize, >> + }, >> + { >> + .name = "st,fmc2-ebi-cs-byte-lane-setup-ns", >> + .calculate = stm32_fmc2_ebi_ns_to_clock_cycles, >> + .set = stm32_fmc2_ebi_set_bl_setup, >> + }, >> + { >> + .name = "st,fmc2-ebi-cs-address-setup-ns", >> + .reg_type = FMC2_REG_BTR, >> + .reset_val = FMC2_BXTR_ADDSET_MAX, >> + .check = stm32_fmc2_ebi_check_async_trans, >> + .calculate = stm32_fmc2_ebi_ns_to_clock_cycles, >> + .set = stm32_fmc2_ebi_set_address_setup, >> + }, >> + { >> + .name = "st,fmc2-ebi-cs-address-hold-ns", >> + .reg_type = FMC2_REG_BTR, >> + .reset_val = FMC2_BXTR_ADDHLD_MAX, >> + .check = stm32_fmc2_ebi_check_address_hold, >> + .calculate = stm32_fmc2_ebi_ns_to_clock_cycles, >> + .set = stm32_fmc2_ebi_set_address_hold, >> + }, >> + { >> + .name = "st,fmc2-ebi-cs-data-setup-ns", >> + .reg_type = FMC2_REG_BTR, >> + .reset_val = FMC2_BXTR_DATAST_MAX, >> + .check = stm32_fmc2_ebi_check_async_trans, >> + .calculate = stm32_fmc2_ebi_ns_to_clock_cycles, >> + .set = stm32_fmc2_ebi_set_data_setup, >> + }, >> + { >> + .name = "st,fmc2-ebi-cs-bus-turnaround-ns", >> + .reg_type = FMC2_REG_BTR, >> + .reset_val = FMC2_BXTR_BUSTURN_MAX + 1, >> + .calculate = stm32_fmc2_ebi_ns_to_clock_cycles, >> + .set = stm32_fmc2_ebi_set_bus_turnaround, >> + }, >> + { >> + .name = "st,fmc2-ebi-cs-data-hold-ns", >> + .reg_type = FMC2_REG_BTR, >> + .check = stm32_fmc2_ebi_check_async_trans, >> + .calculate = stm32_fmc2_ebi_ns_to_clock_cycles, >> + .set = stm32_fmc2_ebi_set_data_hold, >> + }, >> + { >> + .name = "st,fmc2-ebi-cs-clk-period-ns", >> + .reset_val = FMC2_BTR_CLKDIV_MAX + 1, >> + .check = stm32_fmc2_ebi_check_clk_period, >> + .calculate = stm32_fmc2_ebi_ns_to_clock_cycles, >> + .set = stm32_fmc2_ebi_set_clk_period, >> + }, >> + { >> + .name = "st,fmc2-ebi-cs-data-latency-ns", >> + .check = stm32_fmc2_ebi_check_sync_trans, >> + .calculate = stm32_fmc2_ebi_ns_to_clk_period, >> + .set = stm32_fmc2_ebi_set_data_latency, >> + }, >> + { >> + .name = "st,fmc2-ebi-cs-write-address-setup-ns", >> + .reg_type = FMC2_REG_BWTR, >> + .reset_val = FMC2_BXTR_ADDSET_MAX, >> + .check = stm32_fmc2_ebi_check_async_trans, >> + .calculate = stm32_fmc2_ebi_ns_to_clock_cycles, >> + .set = stm32_fmc2_ebi_set_address_setup, >> + }, >> + { >> + .name = "st,fmc2-ebi-cs-write-address-hold-ns", >> + .reg_type = FMC2_REG_BWTR, >> + .reset_val = FMC2_BXTR_ADDHLD_MAX, >> + .check = stm32_fmc2_ebi_check_address_hold, >> + .calculate = stm32_fmc2_ebi_ns_to_clock_cycles, >> + .set = stm32_fmc2_ebi_set_address_hold, >> + }, >> + { >> + .name = "st,fmc2-ebi-cs-write-data-setup-ns", >> + .reg_type = FMC2_REG_BWTR, >> + .reset_val = FMC2_BXTR_DATAST_MAX, >> + .check = stm32_fmc2_ebi_check_async_trans, >> + .calculate = stm32_fmc2_ebi_ns_to_clock_cycles, >> + .set = stm32_fmc2_ebi_set_data_setup, >> + }, >> + { >> + .name = "st,fmc2-ebi-cs-write-bus-turnaround-ns", >> + .reg_type = FMC2_REG_BWTR, >> + .reset_val = FMC2_BXTR_BUSTURN_MAX + 1, >> + .calculate = stm32_fmc2_ebi_ns_to_clock_cycles, >> + .set = stm32_fmc2_ebi_set_bus_turnaround, >> + }, >> + { >> + .name = "st,fmc2-ebi-cs-write-data-hold-ns", >> + .reg_type = FMC2_REG_BWTR, >> + .check = stm32_fmc2_ebi_check_async_trans, >> + .calculate = stm32_fmc2_ebi_ns_to_clock_cycles, >> + .set = stm32_fmc2_ebi_set_data_hold, >> + }, >> + { >> + .name = "st,fmc2-ebi-cs-max-low-pulse-ns", >> + .calculate = stm32_fmc2_ebi_ns_to_clock_cycles, >> + .set = stm32_fmc2_ebi_set_max_low_pulse, >> + }, >> +}; >> + >> +static int stm32_fmc2_ebi_parse_prop(struct stm32_fmc2_ebi *ebi, >> + ofnode node, >> + const struct stm32_fmc2_prop *prop, >> + int cs) >> +{ >> + u32 setup = 0; >> + >> + if (!prop->set) { >> + pr_err("property %s is not well defined\n", prop->name); >> + return -EINVAL; >> + } >> + >> + if (prop->check && prop->check(ebi, prop, cs)) >> + /* Skip this property */ >> + return 0; >> + >> + if (prop->bprop) { >> + bool bprop; >> + >> + bprop = ofnode_read_bool(node, prop->name); >> + if (prop->mprop && !bprop) { >> + pr_err("mandatory property %s not defined in the device tree\n", >> + prop->name); >> + return -EINVAL; >> + } >> + >> + if (bprop) >> + setup = 1; >> + } else { >> + u32 val; >> + int ret; >> + >> + ret = ofnode_read_u32(node, prop->name, &val); >> + if (prop->mprop && ret) { >> + pr_err("mandatory property %s not defined in the device tree\n", >> + prop->name); >> + return ret; >> + } >> + >> + if (ret) >> + setup = prop->reset_val; >> + else if (prop->calculate) >> + setup = prop->calculate(ebi, cs, val); >> + else >> + setup = val; >> + } >> + >> + return prop->set(ebi, prop, cs, setup); >> +} >> + >> +static void stm32_fmc2_ebi_enable_bank(struct stm32_fmc2_ebi *ebi, int cs) >> +{ >> + setbits_le32(ebi->io_base + FMC2_BCR(cs), FMC2_BCR_MBKEN); >> +} >> + >> +static void stm32_fmc2_ebi_disable_bank(struct stm32_fmc2_ebi *ebi, int cs) >> +{ >> + clrbits_le32(ebi->io_base + FMC2_BCR(cs), FMC2_BCR_MBKEN); >> +} >> + >> +/* NWAIT signal can not be connected to EBI controller and NAND controller */ >> +static bool stm32_fmc2_ebi_nwait_used_by_ctrls(struct stm32_fmc2_ebi *ebi) >> +{ >> + unsigned int cs; >> + u32 bcr; >> + >> + for (cs = 0; cs < FMC2_MAX_EBI_CE; cs++) { >> + if (!(ebi->bank_assigned & BIT(cs))) >> + continue; >> + >> + bcr = readl(ebi->io_base + FMC2_BCR(cs)); >> + if ((bcr & FMC2_BCR_WAITEN || bcr & FMC2_BCR_ASYNCWAIT) && >> + ebi->bank_assigned & BIT(FMC2_NAND)) >> + return true; >> + } >> + >> + return false; >> +} >> + >> +static void stm32_fmc2_ebi_enable(struct stm32_fmc2_ebi *ebi) >> +{ >> + setbits_le32(ebi->io_base + FMC2_BCR1, FMC2_BCR1_FMC2EN); >> +} >> + >> +static int stm32_fmc2_ebi_setup_cs(struct stm32_fmc2_ebi *ebi, >> + ofnode node, u32 cs) >> +{ >> + unsigned int i; >> + int ret; >> + >> + stm32_fmc2_ebi_disable_bank(ebi, cs); >> + >> + for (i = 0; i < ARRAY_SIZE(stm32_fmc2_child_props); i++) { >> + const struct stm32_fmc2_prop *p = &stm32_fmc2_child_props[i]; >> + >> + ret = stm32_fmc2_ebi_parse_prop(ebi, node, p, cs); >> + if (ret) { >> + pr_err("property %s could not be set: %d\n", >> + p->name, ret); >> + return ret; >> + } >> + } >> + >> + stm32_fmc2_ebi_enable_bank(ebi, cs); >> + >> + return 0; >> +} >> + >> +static int stm32_fmc2_ebi_parse_dt(struct udevice *dev, >> + struct stm32_fmc2_ebi *ebi) >> +{ >> + ofnode child; >> + bool child_found = false; >> + u32 bank; >> + int ret; >> + >> + dev_for_each_subnode(child, dev) { >> + ret = ofnode_read_u32(child, "reg", &bank); >> + if (ret) { >> + pr_err("could not retrieve reg property: %d\n", ret); >> + return ret; >> + } >> + >> + if (bank >= FMC2_MAX_BANKS) { >> + pr_err("invalid reg value: %d\n", bank); >> + return -EINVAL; >> + } >> + >> + if (ebi->bank_assigned & BIT(bank)) { >> + pr_err("bank already assigned: %d\n", bank); >> + return -EINVAL; >> + } >> + >> + if (bank < FMC2_MAX_EBI_CE) { >> + ret = stm32_fmc2_ebi_setup_cs(ebi, child, bank); >> + if (ret) { >> + pr_err("setup chip select %d failed: %d\n", >> + bank, ret); >> + return ret; >> + } >> + } >> + >> + ebi->bank_assigned |= BIT(bank); >> + child_found = true; >> + } >> + >> + if (!child_found) { >> + pr_warn("no subnodes found, disable the driver.\n"); >> + return -ENODEV; >> + } >> + >> + if (stm32_fmc2_ebi_nwait_used_by_ctrls(ebi)) { >> + pr_err("NWAIT signal connected to EBI and NAND controllers\n"); >> + return -EINVAL; >> + } >> + >> + stm32_fmc2_ebi_enable(ebi); >> + >> + return 0; >> +} >> + >> +static int stm32_fmc2_ebi_probe(struct udevice *dev) >> +{ >> + struct stm32_fmc2_ebi *ebi = dev_get_priv(dev); >> + struct reset_ctl reset; >> + int ret; >> + >> + ebi->io_base = dev_read_addr(dev); >> + if (ebi->io_base == FDT_ADDR_T_NONE) >> + return -EINVAL; >> + >> + ret = clk_get_by_index(dev, 0, &ebi->clk); >> + if (ret) >> + return ret; >> + >> + ret = clk_enable(&ebi->clk); >> + if (ret) >> + return ret; >> + >> + ret = reset_get_by_index(dev, 0, &reset); >> + if (!ret) { >> + reset_assert(&reset); >> + udelay(2); >> + reset_deassert(&reset); >> + } >> + >> + return stm32_fmc2_ebi_parse_dt(dev, ebi); >> +} >> + >> +static const struct udevice_id stm32_fmc2_ebi_match[] = { >> + {.compatible = "st,stm32mp1-fmc2-ebi"}, >> + { /* Sentinel */ } >> +}; >> + >> +U_BOOT_DRIVER(stm32_fmc2_ebi) = { >> + .name = "stm32_fmc2_ebi", >> + .id = UCLASS_NOP, >> + .of_match = stm32_fmc2_ebi_match, >> + .probe = stm32_fmc2_ebi_probe, >> + .priv_auto_alloc_size = sizeof(struct stm32_fmc2_ebi), >> + .bind = dm_scan_fdt_dev, >> +}; > Reviewed-by: Patrice Chotard <patrice.chotard@st.com> > > Thanks > > Patrice >
diff --git a/drivers/memory/Kconfig b/drivers/memory/Kconfig index 4fbb5aa..7271892 100644 --- a/drivers/memory/Kconfig +++ b/drivers/memory/Kconfig @@ -4,6 +4,15 @@ menu "Memory Controller drivers" +config STM32_FMC2_EBI + bool "Support for FMC2 External Bus Interface on STM32MP SoCs" + depends on ARCH_STM32MP + help + Select this option to enable the STM32 FMC2 External Bus Interface + controller. This driver configures the transactions with external + devices (like SRAM, ethernet adapters, FPGAs, LCD displays, ...) on + SOCs containing the FMC2 External Bus Interface. + config TI_AEMIF tristate "Texas Instruments AEMIF driver" depends on ARCH_KEYSTONE diff --git a/drivers/memory/Makefile b/drivers/memory/Makefile index 238add0..fec52ef 100644 --- a/drivers/memory/Makefile +++ b/drivers/memory/Makefile @@ -1,2 +1,3 @@ +obj-$(CONFIG_STM32_FMC2_EBI) += stm32-fmc2-ebi.o obj-$(CONFIG_TI_AEMIF) += ti-aemif.o diff --git a/drivers/memory/stm32-fmc2-ebi.c b/drivers/memory/stm32-fmc2-ebi.c new file mode 100644 index 0000000..d887a1e --- /dev/null +++ b/drivers/memory/stm32-fmc2-ebi.c @@ -0,0 +1,1056 @@ +// SPDX-License-Identifier: GPL-2.0+ OR BSD-3-Clause +/* + * Copyright (C) STMicroelectronics 2020 + */ + +#include <common.h> +#include <clk.h> +#include <dm.h> +#include <reset.h> +#include <linux/bitfield.h> +#include <linux/err.h> +#include <linux/iopoll.h> +#include <linux/ioport.h> + +/* FMC2 Controller Registers */ +#define FMC2_BCR1 0x0 +#define FMC2_BTR1 0x4 +#define FMC2_BCR(x) ((x) * 0x8 + FMC2_BCR1) +#define FMC2_BTR(x) ((x) * 0x8 + FMC2_BTR1) +#define FMC2_PCSCNTR 0x20 +#define FMC2_BWTR1 0x104 +#define FMC2_BWTR(x) ((x) * 0x8 + FMC2_BWTR1) + +/* Register: FMC2_BCR1 */ +#define FMC2_BCR1_CCLKEN BIT(20) +#define FMC2_BCR1_FMC2EN BIT(31) + +/* Register: FMC2_BCRx */ +#define FMC2_BCR_MBKEN BIT(0) +#define FMC2_BCR_MUXEN BIT(1) +#define FMC2_BCR_MTYP GENMASK(3, 2) +#define FMC2_BCR_MWID GENMASK(5, 4) +#define FMC2_BCR_FACCEN BIT(6) +#define FMC2_BCR_BURSTEN BIT(8) +#define FMC2_BCR_WAITPOL BIT(9) +#define FMC2_BCR_WAITCFG BIT(11) +#define FMC2_BCR_WREN BIT(12) +#define FMC2_BCR_WAITEN BIT(13) +#define FMC2_BCR_EXTMOD BIT(14) +#define FMC2_BCR_ASYNCWAIT BIT(15) +#define FMC2_BCR_CPSIZE GENMASK(18, 16) +#define FMC2_BCR_CBURSTRW BIT(19) +#define FMC2_BCR_NBLSET GENMASK(23, 22) + +/* Register: FMC2_BTRx/FMC2_BWTRx */ +#define FMC2_BXTR_ADDSET GENMASK(3, 0) +#define FMC2_BXTR_ADDHLD GENMASK(7, 4) +#define FMC2_BXTR_DATAST GENMASK(15, 8) +#define FMC2_BXTR_BUSTURN GENMASK(19, 16) +#define FMC2_BTR_CLKDIV GENMASK(23, 20) +#define FMC2_BTR_DATLAT GENMASK(27, 24) +#define FMC2_BXTR_ACCMOD GENMASK(29, 28) +#define FMC2_BXTR_DATAHLD GENMASK(31, 30) + +/* Register: FMC2_PCSCNTR */ +#define FMC2_PCSCNTR_CSCOUNT GENMASK(15, 0) +#define FMC2_PCSCNTR_CNTBEN(x) BIT((x) + 16) + +#define FMC2_MAX_EBI_CE 4 +#define FMC2_MAX_BANKS 5 + +#define FMC2_BCR_CPSIZE_0 0x0 +#define FMC2_BCR_CPSIZE_128 0x1 +#define FMC2_BCR_CPSIZE_256 0x2 +#define FMC2_BCR_CPSIZE_512 0x3 +#define FMC2_BCR_CPSIZE_1024 0x4 + +#define FMC2_BCR_MWID_8 0x0 +#define FMC2_BCR_MWID_16 0x1 + +#define FMC2_BCR_MTYP_SRAM 0x0 +#define FMC2_BCR_MTYP_PSRAM 0x1 +#define FMC2_BCR_MTYP_NOR 0x2 + +#define FMC2_BXTR_EXTMOD_A 0x0 +#define FMC2_BXTR_EXTMOD_B 0x1 +#define FMC2_BXTR_EXTMOD_C 0x2 +#define FMC2_BXTR_EXTMOD_D 0x3 + +#define FMC2_BCR_NBLSET_MAX 0x3 +#define FMC2_BXTR_ADDSET_MAX 0xf +#define FMC2_BXTR_ADDHLD_MAX 0xf +#define FMC2_BXTR_DATAST_MAX 0xff +#define FMC2_BXTR_BUSTURN_MAX 0xf +#define FMC2_BXTR_DATAHLD_MAX 0x3 +#define FMC2_BTR_CLKDIV_MAX 0xf +#define FMC2_BTR_DATLAT_MAX 0xf +#define FMC2_PCSCNTR_CSCOUNT_MAX 0xff + +#define FMC2_NSEC_PER_SEC 1000000000L + +enum stm32_fmc2_ebi_bank { + FMC2_EBI1 = 0, + FMC2_EBI2, + FMC2_EBI3, + FMC2_EBI4, + FMC2_NAND +}; + +enum stm32_fmc2_ebi_register_type { + FMC2_REG_BCR = 1, + FMC2_REG_BTR, + FMC2_REG_BWTR, + FMC2_REG_PCSCNTR +}; + +enum stm32_fmc2_ebi_transaction_type { + FMC2_ASYNC_MODE_1_SRAM = 0, + FMC2_ASYNC_MODE_1_PSRAM, + FMC2_ASYNC_MODE_A_SRAM, + FMC2_ASYNC_MODE_A_PSRAM, + FMC2_ASYNC_MODE_2_NOR, + FMC2_ASYNC_MODE_B_NOR, + FMC2_ASYNC_MODE_C_NOR, + FMC2_ASYNC_MODE_D_NOR, + FMC2_SYNC_READ_SYNC_WRITE_PSRAM, + FMC2_SYNC_READ_ASYNC_WRITE_PSRAM, + FMC2_SYNC_READ_SYNC_WRITE_NOR, + FMC2_SYNC_READ_ASYNC_WRITE_NOR +}; + +enum stm32_fmc2_ebi_buswidth { + FMC2_BUSWIDTH_8 = 8, + FMC2_BUSWIDTH_16 = 16 +}; + +enum stm32_fmc2_ebi_cpsize { + FMC2_CPSIZE_0 = 0, + FMC2_CPSIZE_128 = 128, + FMC2_CPSIZE_256 = 256, + FMC2_CPSIZE_512 = 512, + FMC2_CPSIZE_1024 = 1024 +}; + +struct stm32_fmc2_ebi { + struct clk clk; + fdt_addr_t io_base; + u8 bank_assigned; +}; + +/* + * struct stm32_fmc2_prop - STM32 FMC2 EBI property + * @name: the device tree binding name of the property + * @bprop: indicate that it is a boolean property + * @mprop: indicate that it is a mandatory property + * @reg_type: the register that have to be modified + * @reg_mask: the bit that have to be modified in the selected register + * in case of it is a boolean property + * @reset_val: the default value that have to be set in case the property + * has not been defined in the device tree + * @check: this callback ckecks that the property is compliant with the + * transaction type selected + * @calculate: this callback is called to calculate for exemple a timing + * set in nanoseconds in the device tree in clock cycles or in + * clock period + * @set: this callback applies the values in the registers + */ +struct stm32_fmc2_prop { + const char *name; + bool bprop; + bool mprop; + int reg_type; + u32 reg_mask; + u32 reset_val; + int (*check)(struct stm32_fmc2_ebi *ebi, + const struct stm32_fmc2_prop *prop, int cs); + u32 (*calculate)(struct stm32_fmc2_ebi *ebi, int cs, u32 setup); + int (*set)(struct stm32_fmc2_ebi *ebi, + const struct stm32_fmc2_prop *prop, + int cs, u32 setup); +}; + +static int stm32_fmc2_ebi_check_mux(struct stm32_fmc2_ebi *ebi, + const struct stm32_fmc2_prop *prop, + int cs) +{ + u32 bcr = readl(ebi->io_base + FMC2_BCR(cs)); + + if (bcr & FMC2_BCR_MTYP) + return 0; + + return -EINVAL; +} + +static int stm32_fmc2_ebi_check_waitcfg(struct stm32_fmc2_ebi *ebi, + const struct stm32_fmc2_prop *prop, + int cs) +{ + u32 bcr = readl(ebi->io_base + FMC2_BCR(cs)); + u32 val = FIELD_PREP(FMC2_BCR_MTYP, FMC2_BCR_MTYP_NOR); + + if ((bcr & FMC2_BCR_MTYP) == val && bcr & FMC2_BCR_BURSTEN) + return 0; + + return -EINVAL; +} + +static int stm32_fmc2_ebi_check_sync_trans(struct stm32_fmc2_ebi *ebi, + const struct stm32_fmc2_prop *prop, + int cs) +{ + u32 bcr = readl(ebi->io_base + FMC2_BCR(cs)); + + if (bcr & FMC2_BCR_BURSTEN) + return 0; + + return -EINVAL; +} + +static int stm32_fmc2_ebi_check_async_trans(struct stm32_fmc2_ebi *ebi, + const struct stm32_fmc2_prop *prop, + int cs) +{ + u32 bcr = readl(ebi->io_base + FMC2_BCR(cs)); + + if (!(bcr & FMC2_BCR_BURSTEN) || !(bcr & FMC2_BCR_CBURSTRW)) + return 0; + + return -EINVAL; +} + +static int stm32_fmc2_ebi_check_cpsize(struct stm32_fmc2_ebi *ebi, + const struct stm32_fmc2_prop *prop, + int cs) +{ + u32 bcr = readl(ebi->io_base + FMC2_BCR(cs)); + u32 val = FIELD_PREP(FMC2_BCR_MTYP, FMC2_BCR_MTYP_PSRAM); + + if ((bcr & FMC2_BCR_MTYP) == val && bcr & FMC2_BCR_BURSTEN) + return 0; + + return -EINVAL; +} + +static int stm32_fmc2_ebi_check_address_hold(struct stm32_fmc2_ebi *ebi, + const struct stm32_fmc2_prop *prop, + int cs) +{ + u32 bcr = readl(ebi->io_base + FMC2_BCR(cs)); + u32 bxtr = prop->reg_type == FMC2_REG_BWTR ? + readl(ebi->io_base + FMC2_BWTR(cs)) : + readl(ebi->io_base + FMC2_BTR(cs)); + u32 val = FIELD_PREP(FMC2_BXTR_ACCMOD, FMC2_BXTR_EXTMOD_D); + + if ((!(bcr & FMC2_BCR_BURSTEN) || !(bcr & FMC2_BCR_CBURSTRW)) && + ((bxtr & FMC2_BXTR_ACCMOD) == val || bcr & FMC2_BCR_MUXEN)) + return 0; + + return -EINVAL; +} + +static int stm32_fmc2_ebi_check_clk_period(struct stm32_fmc2_ebi *ebi, + const struct stm32_fmc2_prop *prop, + int cs) +{ + u32 bcr = readl(ebi->io_base + FMC2_BCR(cs)); + u32 bcr1 = cs ? readl(ebi->io_base + FMC2_BCR1) : bcr; + + if (bcr & FMC2_BCR_BURSTEN && (!cs || !(bcr1 & FMC2_BCR1_CCLKEN))) + return 0; + + return -EINVAL; +} + +static int stm32_fmc2_ebi_check_cclk(struct stm32_fmc2_ebi *ebi, + const struct stm32_fmc2_prop *prop, + int cs) +{ + if (cs) + return -EINVAL; + + return stm32_fmc2_ebi_check_sync_trans(ebi, prop, cs); +} + +static u32 stm32_fmc2_ebi_ns_to_clock_cycles(struct stm32_fmc2_ebi *ebi, + int cs, u32 setup) +{ + unsigned long hclk = clk_get_rate(&ebi->clk); + unsigned long hclkp = FMC2_NSEC_PER_SEC / (hclk / 1000); + + return DIV_ROUND_UP(setup * 1000, hclkp); +} + +static u32 stm32_fmc2_ebi_ns_to_clk_period(struct stm32_fmc2_ebi *ebi, + int cs, u32 setup) +{ + u32 nb_clk_cycles = stm32_fmc2_ebi_ns_to_clock_cycles(ebi, cs, setup); + u32 bcr = readl(ebi->io_base + FMC2_BCR1); + u32 btr = bcr & FMC2_BCR1_CCLKEN || !cs ? + readl(ebi->io_base + FMC2_BTR1) : + readl(ebi->io_base + FMC2_BTR(cs)); + u32 clk_period = FIELD_GET(FMC2_BTR_CLKDIV, btr) + 1; + + return DIV_ROUND_UP(nb_clk_cycles, clk_period); +} + +static int stm32_fmc2_ebi_get_reg(int reg_type, int cs, u32 *reg) +{ + switch (reg_type) { + case FMC2_REG_BCR: + *reg = FMC2_BCR(cs); + break; + case FMC2_REG_BTR: + *reg = FMC2_BTR(cs); + break; + case FMC2_REG_BWTR: + *reg = FMC2_BWTR(cs); + break; + case FMC2_REG_PCSCNTR: + *reg = FMC2_PCSCNTR; + break; + default: + return -EINVAL; + } + + return 0; +} + +static int stm32_fmc2_ebi_set_bit_field(struct stm32_fmc2_ebi *ebi, + const struct stm32_fmc2_prop *prop, + int cs, u32 setup) +{ + u32 reg; + int ret; + + ret = stm32_fmc2_ebi_get_reg(prop->reg_type, cs, ®); + if (ret) + return ret; + + clrsetbits_le32(ebi->io_base + reg, prop->reg_mask, + setup ? prop->reg_mask : 0); + + return 0; +} + +static int stm32_fmc2_ebi_set_trans_type(struct stm32_fmc2_ebi *ebi, + const struct stm32_fmc2_prop *prop, + int cs, u32 setup) +{ + u32 bcr_mask, bcr = FMC2_BCR_WREN; + u32 btr_mask, btr = 0; + u32 bwtr_mask, bwtr = 0; + + bwtr_mask = FMC2_BXTR_ACCMOD; + btr_mask = FMC2_BXTR_ACCMOD; + bcr_mask = FMC2_BCR_MUXEN | FMC2_BCR_MTYP | FMC2_BCR_FACCEN | + FMC2_BCR_WREN | FMC2_BCR_WAITEN | FMC2_BCR_BURSTEN | + FMC2_BCR_EXTMOD | FMC2_BCR_CBURSTRW; + + switch (setup) { + case FMC2_ASYNC_MODE_1_SRAM: + bcr |= FIELD_PREP(FMC2_BCR_MTYP, FMC2_BCR_MTYP_SRAM); + /* + * MUXEN = 0, MTYP = 0, FACCEN = 0, BURSTEN = 0, WAITEN = 0, + * WREN = 1, EXTMOD = 0, CBURSTRW = 0, ACCMOD = 0 + */ + break; + case FMC2_ASYNC_MODE_1_PSRAM: + /* + * MUXEN = 0, MTYP = 1, FACCEN = 0, BURSTEN = 0, WAITEN = 0, + * WREN = 1, EXTMOD = 0, CBURSTRW = 0, ACCMOD = 0 + */ + bcr |= FIELD_PREP(FMC2_BCR_MTYP, FMC2_BCR_MTYP_PSRAM); + break; + case FMC2_ASYNC_MODE_A_SRAM: + /* + * MUXEN = 0, MTYP = 0, FACCEN = 0, BURSTEN = 0, WAITEN = 0, + * WREN = 1, EXTMOD = 1, CBURSTRW = 0, ACCMOD = 0 + */ + bcr |= FIELD_PREP(FMC2_BCR_MTYP, FMC2_BCR_MTYP_SRAM); + bcr |= FMC2_BCR_EXTMOD; + btr |= FIELD_PREP(FMC2_BXTR_ACCMOD, FMC2_BXTR_EXTMOD_A); + bwtr |= FIELD_PREP(FMC2_BXTR_ACCMOD, FMC2_BXTR_EXTMOD_A); + break; + case FMC2_ASYNC_MODE_A_PSRAM: + /* + * MUXEN = 0, MTYP = 1, FACCEN = 0, BURSTEN = 0, WAITEN = 0, + * WREN = 1, EXTMOD = 1, CBURSTRW = 0, ACCMOD = 0 + */ + bcr |= FIELD_PREP(FMC2_BCR_MTYP, FMC2_BCR_MTYP_PSRAM); + bcr |= FMC2_BCR_EXTMOD; + btr |= FIELD_PREP(FMC2_BXTR_ACCMOD, FMC2_BXTR_EXTMOD_A); + bwtr |= FIELD_PREP(FMC2_BXTR_ACCMOD, FMC2_BXTR_EXTMOD_A); + break; + case FMC2_ASYNC_MODE_2_NOR: + /* + * MUXEN = 0, MTYP = 2, FACCEN = 1, BURSTEN = 0, WAITEN = 0, + * WREN = 1, EXTMOD = 0, CBURSTRW = 0, ACCMOD = 0 + */ + bcr |= FIELD_PREP(FMC2_BCR_MTYP, FMC2_BCR_MTYP_NOR); + bcr |= FMC2_BCR_FACCEN; + break; + case FMC2_ASYNC_MODE_B_NOR: + /* + * MUXEN = 0, MTYP = 2, FACCEN = 1, BURSTEN = 0, WAITEN = 0, + * WREN = 1, EXTMOD = 1, CBURSTRW = 0, ACCMOD = 1 + */ + bcr |= FIELD_PREP(FMC2_BCR_MTYP, FMC2_BCR_MTYP_NOR); + bcr |= FMC2_BCR_FACCEN | FMC2_BCR_EXTMOD; + btr |= FIELD_PREP(FMC2_BXTR_ACCMOD, FMC2_BXTR_EXTMOD_B); + bwtr |= FIELD_PREP(FMC2_BXTR_ACCMOD, FMC2_BXTR_EXTMOD_B); + break; + case FMC2_ASYNC_MODE_C_NOR: + /* + * MUXEN = 0, MTYP = 2, FACCEN = 1, BURSTEN = 0, WAITEN = 0, + * WREN = 1, EXTMOD = 1, CBURSTRW = 0, ACCMOD = 2 + */ + bcr |= FIELD_PREP(FMC2_BCR_MTYP, FMC2_BCR_MTYP_NOR); + bcr |= FMC2_BCR_FACCEN | FMC2_BCR_EXTMOD; + btr |= FIELD_PREP(FMC2_BXTR_ACCMOD, FMC2_BXTR_EXTMOD_C); + bwtr |= FIELD_PREP(FMC2_BXTR_ACCMOD, FMC2_BXTR_EXTMOD_C); + break; + case FMC2_ASYNC_MODE_D_NOR: + /* + * MUXEN = 0, MTYP = 2, FACCEN = 1, BURSTEN = 0, WAITEN = 0, + * WREN = 1, EXTMOD = 1, CBURSTRW = 0, ACCMOD = 3 + */ + bcr |= FIELD_PREP(FMC2_BCR_MTYP, FMC2_BCR_MTYP_NOR); + bcr |= FMC2_BCR_FACCEN | FMC2_BCR_EXTMOD; + btr |= FIELD_PREP(FMC2_BXTR_ACCMOD, FMC2_BXTR_EXTMOD_D); + bwtr |= FIELD_PREP(FMC2_BXTR_ACCMOD, FMC2_BXTR_EXTMOD_D); + break; + case FMC2_SYNC_READ_SYNC_WRITE_PSRAM: + /* + * MUXEN = 0, MTYP = 1, FACCEN = 0, BURSTEN = 1, WAITEN = 0, + * WREN = 1, EXTMOD = 0, CBURSTRW = 1, ACCMOD = 0 + */ + bcr |= FIELD_PREP(FMC2_BCR_MTYP, FMC2_BCR_MTYP_PSRAM); + bcr |= FMC2_BCR_BURSTEN | FMC2_BCR_CBURSTRW; + break; + case FMC2_SYNC_READ_ASYNC_WRITE_PSRAM: + /* + * MUXEN = 0, MTYP = 1, FACCEN = 0, BURSTEN = 1, WAITEN = 0, + * WREN = 1, EXTMOD = 0, CBURSTRW = 0, ACCMOD = 0 + */ + bcr |= FIELD_PREP(FMC2_BCR_MTYP, FMC2_BCR_MTYP_PSRAM); + bcr |= FMC2_BCR_BURSTEN; + break; + case FMC2_SYNC_READ_SYNC_WRITE_NOR: + /* + * MUXEN = 0, MTYP = 2, FACCEN = 1, BURSTEN = 1, WAITEN = 0, + * WREN = 1, EXTMOD = 0, CBURSTRW = 1, ACCMOD = 0 + */ + bcr |= FIELD_PREP(FMC2_BCR_MTYP, FMC2_BCR_MTYP_NOR); + bcr |= FMC2_BCR_FACCEN | FMC2_BCR_BURSTEN | FMC2_BCR_CBURSTRW; + break; + case FMC2_SYNC_READ_ASYNC_WRITE_NOR: + /* + * MUXEN = 0, MTYP = 2, FACCEN = 1, BURSTEN = 1, WAITEN = 0, + * WREN = 1, EXTMOD = 0, CBURSTRW = 0, ACCMOD = 0 + */ + bcr |= FIELD_PREP(FMC2_BCR_MTYP, FMC2_BCR_MTYP_NOR); + bcr |= FMC2_BCR_FACCEN | FMC2_BCR_BURSTEN; + break; + default: + /* Type of transaction not supported */ + return -EINVAL; + } + + if (bcr & FMC2_BCR_EXTMOD) + clrsetbits_le32(ebi->io_base + FMC2_BWTR(cs), + bwtr_mask, bwtr); + clrsetbits_le32(ebi->io_base + FMC2_BTR(cs), btr_mask, btr); + clrsetbits_le32(ebi->io_base + FMC2_BCR(cs), bcr_mask, bcr); + + return 0; +} + +static int stm32_fmc2_ebi_set_buswidth(struct stm32_fmc2_ebi *ebi, + const struct stm32_fmc2_prop *prop, + int cs, u32 setup) +{ + u32 val; + + switch (setup) { + case FMC2_BUSWIDTH_8: + val = FIELD_PREP(FMC2_BCR_MWID, FMC2_BCR_MWID_8); + break; + case FMC2_BUSWIDTH_16: + val = FIELD_PREP(FMC2_BCR_MWID, FMC2_BCR_MWID_16); + break; + default: + /* Buswidth not supported */ + return -EINVAL; + } + + clrsetbits_le32(ebi->io_base + FMC2_BCR(cs), FMC2_BCR_MWID, val); + + return 0; +} + +static int stm32_fmc2_ebi_set_cpsize(struct stm32_fmc2_ebi *ebi, + const struct stm32_fmc2_prop *prop, + int cs, u32 setup) +{ + u32 val; + + switch (setup) { + case FMC2_CPSIZE_0: + val = FIELD_PREP(FMC2_BCR_CPSIZE, FMC2_BCR_CPSIZE_0); + break; + case FMC2_CPSIZE_128: + val = FIELD_PREP(FMC2_BCR_CPSIZE, FMC2_BCR_CPSIZE_128); + break; + case FMC2_CPSIZE_256: + val = FIELD_PREP(FMC2_BCR_CPSIZE, FMC2_BCR_CPSIZE_256); + break; + case FMC2_CPSIZE_512: + val = FIELD_PREP(FMC2_BCR_CPSIZE, FMC2_BCR_CPSIZE_512); + break; + case FMC2_CPSIZE_1024: + val = FIELD_PREP(FMC2_BCR_CPSIZE, FMC2_BCR_CPSIZE_1024); + break; + default: + /* Cpsize not supported */ + return -EINVAL; + } + + clrsetbits_le32(ebi->io_base + FMC2_BCR(cs), FMC2_BCR_CPSIZE, val); + + return 0; +} + +static int stm32_fmc2_ebi_set_bl_setup(struct stm32_fmc2_ebi *ebi, + const struct stm32_fmc2_prop *prop, + int cs, u32 setup) +{ + u32 val; + + val = min_t(u32, setup, FMC2_BCR_NBLSET_MAX); + val = FIELD_PREP(FMC2_BCR_NBLSET, val); + clrsetbits_le32(ebi->io_base + FMC2_BCR(cs), FMC2_BCR_NBLSET, val); + + return 0; +} + +static int stm32_fmc2_ebi_set_address_setup(struct stm32_fmc2_ebi *ebi, + const struct stm32_fmc2_prop *prop, + int cs, u32 setup) +{ + u32 bcr = readl(ebi->io_base + FMC2_BCR(cs)); + u32 bxtr = prop->reg_type == FMC2_REG_BWTR ? + readl(ebi->io_base + FMC2_BWTR(cs)) : + readl(ebi->io_base + FMC2_BTR(cs)); + u32 reg, val = FIELD_PREP(FMC2_BXTR_ACCMOD, FMC2_BXTR_EXTMOD_D); + int ret; + + ret = stm32_fmc2_ebi_get_reg(prop->reg_type, cs, ®); + if (ret) + return ret; + + if ((bxtr & FMC2_BXTR_ACCMOD) == val || bcr & FMC2_BCR_MUXEN) + val = clamp_val(setup, 1, FMC2_BXTR_ADDSET_MAX); + else + val = min_t(u32, setup, FMC2_BXTR_ADDSET_MAX); + val = FIELD_PREP(FMC2_BXTR_ADDSET, val); + clrsetbits_le32(ebi->io_base + reg, FMC2_BXTR_ADDSET, val); + + return 0; +} + +static int stm32_fmc2_ebi_set_address_hold(struct stm32_fmc2_ebi *ebi, + const struct stm32_fmc2_prop *prop, + int cs, u32 setup) +{ + u32 val, reg; + int ret; + + ret = stm32_fmc2_ebi_get_reg(prop->reg_type, cs, ®); + if (ret) + return ret; + + val = clamp_val(setup, 1, FMC2_BXTR_ADDHLD_MAX); + val = FIELD_PREP(FMC2_BXTR_ADDHLD, val); + clrsetbits_le32(ebi->io_base + reg, FMC2_BXTR_ADDHLD, val); + + return 0; +} + +static int stm32_fmc2_ebi_set_data_setup(struct stm32_fmc2_ebi *ebi, + const struct stm32_fmc2_prop *prop, + int cs, u32 setup) +{ + u32 val, reg; + int ret; + + ret = stm32_fmc2_ebi_get_reg(prop->reg_type, cs, ®); + if (ret) + return ret; + + val = clamp_val(setup, 1, FMC2_BXTR_DATAST_MAX); + val = FIELD_PREP(FMC2_BXTR_DATAST, val); + clrsetbits_le32(ebi->io_base + reg, FMC2_BXTR_DATAST, val); + + return 0; +} + +static int stm32_fmc2_ebi_set_bus_turnaround(struct stm32_fmc2_ebi *ebi, + const struct stm32_fmc2_prop *prop, + int cs, u32 setup) +{ + u32 val, reg; + int ret; + + ret = stm32_fmc2_ebi_get_reg(prop->reg_type, cs, ®); + if (ret) + return ret; + + val = setup ? min_t(u32, setup - 1, FMC2_BXTR_BUSTURN_MAX) : 0; + val = FIELD_PREP(FMC2_BXTR_BUSTURN, val); + clrsetbits_le32(ebi->io_base + reg, FMC2_BXTR_BUSTURN, val); + + return 0; +} + +static int stm32_fmc2_ebi_set_data_hold(struct stm32_fmc2_ebi *ebi, + const struct stm32_fmc2_prop *prop, + int cs, u32 setup) +{ + u32 val, reg; + int ret; + + ret = stm32_fmc2_ebi_get_reg(prop->reg_type, cs, ®); + if (ret) + return ret; + + if (prop->reg_type == FMC2_REG_BWTR) + val = setup ? min_t(u32, setup - 1, FMC2_BXTR_DATAHLD_MAX) : 0; + else + val = min_t(u32, setup, FMC2_BXTR_DATAHLD_MAX); + val = FIELD_PREP(FMC2_BXTR_DATAHLD, val); + clrsetbits_le32(ebi->io_base + reg, FMC2_BXTR_DATAHLD, val); + + return 0; +} + +static int stm32_fmc2_ebi_set_clk_period(struct stm32_fmc2_ebi *ebi, + const struct stm32_fmc2_prop *prop, + int cs, u32 setup) +{ + u32 val; + + val = setup ? clamp_val(setup - 1, 1, FMC2_BTR_CLKDIV_MAX) : 1; + val = FIELD_PREP(FMC2_BTR_CLKDIV, val); + clrsetbits_le32(ebi->io_base + FMC2_BTR(cs), FMC2_BTR_CLKDIV, val); + + return 0; +} + +static int stm32_fmc2_ebi_set_data_latency(struct stm32_fmc2_ebi *ebi, + const struct stm32_fmc2_prop *prop, + int cs, u32 setup) +{ + u32 val; + + val = setup > 1 ? min_t(u32, setup - 2, FMC2_BTR_DATLAT_MAX) : 0; + val = FIELD_PREP(FMC2_BTR_DATLAT, val); + clrsetbits_le32(ebi->io_base + FMC2_BTR(cs), FMC2_BTR_DATLAT, val); + + return 0; +} + +static int stm32_fmc2_ebi_set_max_low_pulse(struct stm32_fmc2_ebi *ebi, + const struct stm32_fmc2_prop *prop, + int cs, u32 setup) +{ + u32 old_val, new_val, pcscntr; + + if (setup < 1) + return 0; + + pcscntr = readl(ebi->io_base + FMC2_PCSCNTR); + + /* Enable counter for the bank */ + setbits_le32(ebi->io_base + FMC2_PCSCNTR, FMC2_PCSCNTR_CNTBEN(cs)); + + new_val = min_t(u32, setup - 1, FMC2_PCSCNTR_CSCOUNT_MAX); + old_val = FIELD_GET(FMC2_PCSCNTR_CSCOUNT, pcscntr); + if (old_val && new_val > old_val) + /* Keep current counter value */ + return 0; + + new_val = FIELD_PREP(FMC2_PCSCNTR_CSCOUNT, new_val); + clrsetbits_le32(ebi->io_base + FMC2_PCSCNTR, + FMC2_PCSCNTR_CSCOUNT, new_val); + + return 0; +} + +static const struct stm32_fmc2_prop stm32_fmc2_child_props[] = { + /* st,fmc2-ebi-cs-trans-type must be the first property */ + { + .name = "st,fmc2-ebi-cs-transaction-type", + .mprop = true, + .set = stm32_fmc2_ebi_set_trans_type, + }, + { + .name = "st,fmc2-ebi-cs-cclk-enable", + .bprop = true, + .reg_type = FMC2_REG_BCR, + .reg_mask = FMC2_BCR1_CCLKEN, + .check = stm32_fmc2_ebi_check_cclk, + .set = stm32_fmc2_ebi_set_bit_field, + }, + { + .name = "st,fmc2-ebi-cs-mux-enable", + .bprop = true, + .reg_type = FMC2_REG_BCR, + .reg_mask = FMC2_BCR_MUXEN, + .check = stm32_fmc2_ebi_check_mux, + .set = stm32_fmc2_ebi_set_bit_field, + }, + { + .name = "st,fmc2-ebi-cs-buswidth", + .reset_val = FMC2_BUSWIDTH_16, + .set = stm32_fmc2_ebi_set_buswidth, + }, + { + .name = "st,fmc2-ebi-cs-waitpol-high", + .bprop = true, + .reg_type = FMC2_REG_BCR, + .reg_mask = FMC2_BCR_WAITPOL, + .set = stm32_fmc2_ebi_set_bit_field, + }, + { + .name = "st,fmc2-ebi-cs-waitcfg-enable", + .bprop = true, + .reg_type = FMC2_REG_BCR, + .reg_mask = FMC2_BCR_WAITCFG, + .check = stm32_fmc2_ebi_check_waitcfg, + .set = stm32_fmc2_ebi_set_bit_field, + }, + { + .name = "st,fmc2-ebi-cs-wait-enable", + .bprop = true, + .reg_type = FMC2_REG_BCR, + .reg_mask = FMC2_BCR_WAITEN, + .check = stm32_fmc2_ebi_check_sync_trans, + .set = stm32_fmc2_ebi_set_bit_field, + }, + { + .name = "st,fmc2-ebi-cs-asyncwait-enable", + .bprop = true, + .reg_type = FMC2_REG_BCR, + .reg_mask = FMC2_BCR_ASYNCWAIT, + .check = stm32_fmc2_ebi_check_async_trans, + .set = stm32_fmc2_ebi_set_bit_field, + }, + { + .name = "st,fmc2-ebi-cs-cpsize", + .check = stm32_fmc2_ebi_check_cpsize, + .set = stm32_fmc2_ebi_set_cpsize, + }, + { + .name = "st,fmc2-ebi-cs-byte-lane-setup-ns", + .calculate = stm32_fmc2_ebi_ns_to_clock_cycles, + .set = stm32_fmc2_ebi_set_bl_setup, + }, + { + .name = "st,fmc2-ebi-cs-address-setup-ns", + .reg_type = FMC2_REG_BTR, + .reset_val = FMC2_BXTR_ADDSET_MAX, + .check = stm32_fmc2_ebi_check_async_trans, + .calculate = stm32_fmc2_ebi_ns_to_clock_cycles, + .set = stm32_fmc2_ebi_set_address_setup, + }, + { + .name = "st,fmc2-ebi-cs-address-hold-ns", + .reg_type = FMC2_REG_BTR, + .reset_val = FMC2_BXTR_ADDHLD_MAX, + .check = stm32_fmc2_ebi_check_address_hold, + .calculate = stm32_fmc2_ebi_ns_to_clock_cycles, + .set = stm32_fmc2_ebi_set_address_hold, + }, + { + .name = "st,fmc2-ebi-cs-data-setup-ns", + .reg_type = FMC2_REG_BTR, + .reset_val = FMC2_BXTR_DATAST_MAX, + .check = stm32_fmc2_ebi_check_async_trans, + .calculate = stm32_fmc2_ebi_ns_to_clock_cycles, + .set = stm32_fmc2_ebi_set_data_setup, + }, + { + .name = "st,fmc2-ebi-cs-bus-turnaround-ns", + .reg_type = FMC2_REG_BTR, + .reset_val = FMC2_BXTR_BUSTURN_MAX + 1, + .calculate = stm32_fmc2_ebi_ns_to_clock_cycles, + .set = stm32_fmc2_ebi_set_bus_turnaround, + }, + { + .name = "st,fmc2-ebi-cs-data-hold-ns", + .reg_type = FMC2_REG_BTR, + .check = stm32_fmc2_ebi_check_async_trans, + .calculate = stm32_fmc2_ebi_ns_to_clock_cycles, + .set = stm32_fmc2_ebi_set_data_hold, + }, + { + .name = "st,fmc2-ebi-cs-clk-period-ns", + .reset_val = FMC2_BTR_CLKDIV_MAX + 1, + .check = stm32_fmc2_ebi_check_clk_period, + .calculate = stm32_fmc2_ebi_ns_to_clock_cycles, + .set = stm32_fmc2_ebi_set_clk_period, + }, + { + .name = "st,fmc2-ebi-cs-data-latency-ns", + .check = stm32_fmc2_ebi_check_sync_trans, + .calculate = stm32_fmc2_ebi_ns_to_clk_period, + .set = stm32_fmc2_ebi_set_data_latency, + }, + { + .name = "st,fmc2-ebi-cs-write-address-setup-ns", + .reg_type = FMC2_REG_BWTR, + .reset_val = FMC2_BXTR_ADDSET_MAX, + .check = stm32_fmc2_ebi_check_async_trans, + .calculate = stm32_fmc2_ebi_ns_to_clock_cycles, + .set = stm32_fmc2_ebi_set_address_setup, + }, + { + .name = "st,fmc2-ebi-cs-write-address-hold-ns", + .reg_type = FMC2_REG_BWTR, + .reset_val = FMC2_BXTR_ADDHLD_MAX, + .check = stm32_fmc2_ebi_check_address_hold, + .calculate = stm32_fmc2_ebi_ns_to_clock_cycles, + .set = stm32_fmc2_ebi_set_address_hold, + }, + { + .name = "st,fmc2-ebi-cs-write-data-setup-ns", + .reg_type = FMC2_REG_BWTR, + .reset_val = FMC2_BXTR_DATAST_MAX, + .check = stm32_fmc2_ebi_check_async_trans, + .calculate = stm32_fmc2_ebi_ns_to_clock_cycles, + .set = stm32_fmc2_ebi_set_data_setup, + }, + { + .name = "st,fmc2-ebi-cs-write-bus-turnaround-ns", + .reg_type = FMC2_REG_BWTR, + .reset_val = FMC2_BXTR_BUSTURN_MAX + 1, + .calculate = stm32_fmc2_ebi_ns_to_clock_cycles, + .set = stm32_fmc2_ebi_set_bus_turnaround, + }, + { + .name = "st,fmc2-ebi-cs-write-data-hold-ns", + .reg_type = FMC2_REG_BWTR, + .check = stm32_fmc2_ebi_check_async_trans, + .calculate = stm32_fmc2_ebi_ns_to_clock_cycles, + .set = stm32_fmc2_ebi_set_data_hold, + }, + { + .name = "st,fmc2-ebi-cs-max-low-pulse-ns", + .calculate = stm32_fmc2_ebi_ns_to_clock_cycles, + .set = stm32_fmc2_ebi_set_max_low_pulse, + }, +}; + +static int stm32_fmc2_ebi_parse_prop(struct stm32_fmc2_ebi *ebi, + ofnode node, + const struct stm32_fmc2_prop *prop, + int cs) +{ + u32 setup = 0; + + if (!prop->set) { + pr_err("property %s is not well defined\n", prop->name); + return -EINVAL; + } + + if (prop->check && prop->check(ebi, prop, cs)) + /* Skip this property */ + return 0; + + if (prop->bprop) { + bool bprop; + + bprop = ofnode_read_bool(node, prop->name); + if (prop->mprop && !bprop) { + pr_err("mandatory property %s not defined in the device tree\n", + prop->name); + return -EINVAL; + } + + if (bprop) + setup = 1; + } else { + u32 val; + int ret; + + ret = ofnode_read_u32(node, prop->name, &val); + if (prop->mprop && ret) { + pr_err("mandatory property %s not defined in the device tree\n", + prop->name); + return ret; + } + + if (ret) + setup = prop->reset_val; + else if (prop->calculate) + setup = prop->calculate(ebi, cs, val); + else + setup = val; + } + + return prop->set(ebi, prop, cs, setup); +} + +static void stm32_fmc2_ebi_enable_bank(struct stm32_fmc2_ebi *ebi, int cs) +{ + setbits_le32(ebi->io_base + FMC2_BCR(cs), FMC2_BCR_MBKEN); +} + +static void stm32_fmc2_ebi_disable_bank(struct stm32_fmc2_ebi *ebi, int cs) +{ + clrbits_le32(ebi->io_base + FMC2_BCR(cs), FMC2_BCR_MBKEN); +} + +/* NWAIT signal can not be connected to EBI controller and NAND controller */ +static bool stm32_fmc2_ebi_nwait_used_by_ctrls(struct stm32_fmc2_ebi *ebi) +{ + unsigned int cs; + u32 bcr; + + for (cs = 0; cs < FMC2_MAX_EBI_CE; cs++) { + if (!(ebi->bank_assigned & BIT(cs))) + continue; + + bcr = readl(ebi->io_base + FMC2_BCR(cs)); + if ((bcr & FMC2_BCR_WAITEN || bcr & FMC2_BCR_ASYNCWAIT) && + ebi->bank_assigned & BIT(FMC2_NAND)) + return true; + } + + return false; +} + +static void stm32_fmc2_ebi_enable(struct stm32_fmc2_ebi *ebi) +{ + setbits_le32(ebi->io_base + FMC2_BCR1, FMC2_BCR1_FMC2EN); +} + +static int stm32_fmc2_ebi_setup_cs(struct stm32_fmc2_ebi *ebi, + ofnode node, u32 cs) +{ + unsigned int i; + int ret; + + stm32_fmc2_ebi_disable_bank(ebi, cs); + + for (i = 0; i < ARRAY_SIZE(stm32_fmc2_child_props); i++) { + const struct stm32_fmc2_prop *p = &stm32_fmc2_child_props[i]; + + ret = stm32_fmc2_ebi_parse_prop(ebi, node, p, cs); + if (ret) { + pr_err("property %s could not be set: %d\n", + p->name, ret); + return ret; + } + } + + stm32_fmc2_ebi_enable_bank(ebi, cs); + + return 0; +} + +static int stm32_fmc2_ebi_parse_dt(struct udevice *dev, + struct stm32_fmc2_ebi *ebi) +{ + ofnode child; + bool child_found = false; + u32 bank; + int ret; + + dev_for_each_subnode(child, dev) { + ret = ofnode_read_u32(child, "reg", &bank); + if (ret) { + pr_err("could not retrieve reg property: %d\n", ret); + return ret; + } + + if (bank >= FMC2_MAX_BANKS) { + pr_err("invalid reg value: %d\n", bank); + return -EINVAL; + } + + if (ebi->bank_assigned & BIT(bank)) { + pr_err("bank already assigned: %d\n", bank); + return -EINVAL; + } + + if (bank < FMC2_MAX_EBI_CE) { + ret = stm32_fmc2_ebi_setup_cs(ebi, child, bank); + if (ret) { + pr_err("setup chip select %d failed: %d\n", + bank, ret); + return ret; + } + } + + ebi->bank_assigned |= BIT(bank); + child_found = true; + } + + if (!child_found) { + pr_warn("no subnodes found, disable the driver.\n"); + return -ENODEV; + } + + if (stm32_fmc2_ebi_nwait_used_by_ctrls(ebi)) { + pr_err("NWAIT signal connected to EBI and NAND controllers\n"); + return -EINVAL; + } + + stm32_fmc2_ebi_enable(ebi); + + return 0; +} + +static int stm32_fmc2_ebi_probe(struct udevice *dev) +{ + struct stm32_fmc2_ebi *ebi = dev_get_priv(dev); + struct reset_ctl reset; + int ret; + + ebi->io_base = dev_read_addr(dev); + if (ebi->io_base == FDT_ADDR_T_NONE) + return -EINVAL; + + ret = clk_get_by_index(dev, 0, &ebi->clk); + if (ret) + return ret; + + ret = clk_enable(&ebi->clk); + if (ret) + return ret; + + ret = reset_get_by_index(dev, 0, &reset); + if (!ret) { + reset_assert(&reset); + udelay(2); + reset_deassert(&reset); + } + + return stm32_fmc2_ebi_parse_dt(dev, ebi); +} + +static const struct udevice_id stm32_fmc2_ebi_match[] = { + {.compatible = "st,stm32mp1-fmc2-ebi"}, + { /* Sentinel */ } +}; + +U_BOOT_DRIVER(stm32_fmc2_ebi) = { + .name = "stm32_fmc2_ebi", + .id = UCLASS_NOP, + .of_match = stm32_fmc2_ebi_match, + .probe = stm32_fmc2_ebi_probe, + .priv_auto_alloc_size = sizeof(struct stm32_fmc2_ebi), + .bind = dm_scan_fdt_dev, +};
The driver adds the support for the STMicroelectronics FMC2 EBI controller found on STM32MP SOCs. Signed-off-by: Christophe Kerello <christophe.kerello@st.com> --- drivers/memory/Kconfig | 9 + drivers/memory/Makefile | 1 + drivers/memory/stm32-fmc2-ebi.c | 1056 +++++++++++++++++++++++++++++++++++++++ 3 files changed, 1066 insertions(+) create mode 100644 drivers/memory/stm32-fmc2-ebi.c