| // SPDX-License-Identifier: GPL-2.0+ OR BSD-3-Clause |
| /* |
| * Copyright (C) STMicroelectronics 2020 |
| */ |
| |
| #define LOG_CATEGORY UCLASS_NOP |
| |
| #include <clk.h> |
| #include <dm.h> |
| #include <reset.h> |
| #include <dm/device_compat.h> |
| #include <linux/bitfield.h> |
| #include <linux/err.h> |
| #include <linux/iopoll.h> |
| #include <linux/ioport.h> |
| #include <linux/time.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_CFGR 0x20 |
| #define FMC2_SR 0x84 |
| #define FMC2_BWTR1 0x104 |
| #define FMC2_BWTR(x) ((x) * 0x8 + FMC2_BWTR1) |
| #define FMC2_SECCFGR 0x300 |
| #define FMC2_CIDCFGR0 0x30c |
| #define FMC2_CIDCFGR(x) ((x) * 0x8 + FMC2_CIDCFGR0) |
| #define FMC2_SEMCR0 0x310 |
| #define FMC2_SEMCR(x) ((x) * 0x8 + FMC2_SEMCR0) |
| |
| /* 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_CSCOUNT GENMASK(21, 20) |
| #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) |
| |
| /* Register: FMC2_CFGR */ |
| #define FMC2_CFGR_CLKDIV GENMASK(19, 16) |
| #define FMC2_CFGR_CCLKEN BIT(20) |
| #define FMC2_CFGR_FMC2EN BIT(31) |
| |
| /* Register: FMC2_SR */ |
| #define FMC2_SR_ISOST GENMASK(1, 0) |
| |
| /* Register: FMC2_CIDCFGR */ |
| #define FMC2_CIDCFGR_CFEN BIT(0) |
| #define FMC2_CIDCFGR_SEMEN BIT(1) |
| #define FMC2_CIDCFGR_SCID GENMASK(6, 4) |
| #define FMC2_CIDCFGR_SEMWLC1 BIT(17) |
| |
| /* Register: FMC2_SEMCR */ |
| #define FMC2_SEMCR_SEM_MUTEX BIT(0) |
| #define FMC2_SEMCR_SEMCID GENMASK(6, 4) |
| |
| #define FMC2_MAX_EBI_CE 4 |
| #define FMC2_MAX_BANKS 5 |
| #define FMC2_MAX_RESOURCES 6 |
| #define FMC2_CID1 1 |
| |
| #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_BCR_CSCOUNT_0 0x0 |
| #define FMC2_BCR_CSCOUNT_1 0x1 |
| #define FMC2_BCR_CSCOUNT_64 0x2 |
| #define FMC2_BCR_CSCOUNT_256 0x3 |
| |
| #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_CFGR_CLKDIV_MAX 0xf |
| |
| 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, |
| FMC2_REG_CFGR |
| }; |
| |
| 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 |
| }; |
| |
| enum stm32_fmc2_ebi_cscount { |
| FMC2_CSCOUNT_0 = 0, |
| FMC2_CSCOUNT_1 = 1, |
| FMC2_CSCOUNT_64 = 64, |
| FMC2_CSCOUNT_256 = 256 |
| }; |
| |
| struct stm32_fmc2_ebi; |
| |
| struct stm32_fmc2_ebi_data { |
| const struct stm32_fmc2_prop *child_props; |
| unsigned int nb_child_props; |
| u32 fmc2_enable_reg; |
| u32 fmc2_enable_bit; |
| int (*nwait_used_by_ctrls)(struct stm32_fmc2_ebi *ebi); |
| int (*check_rif)(struct stm32_fmc2_ebi *ebi, u32 resource); |
| }; |
| |
| struct stm32_fmc2_ebi { |
| struct clk clk; |
| fdt_addr_t io_base; |
| const struct stm32_fmc2_ebi_data *data; |
| u8 bank_assigned; |
| bool access_granted; |
| }; |
| |
| /* |
| * 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_mp25_check_cclk(struct stm32_fmc2_ebi *ebi, |
| const struct stm32_fmc2_prop *prop, |
| int cs) |
| { |
| if (!ebi->access_granted) |
| return -EACCES; |
| |
| return stm32_fmc2_ebi_check_sync_trans(ebi, prop, cs); |
| } |
| |
| static int stm32_fmc2_ebi_mp25_check_clk_period(struct stm32_fmc2_ebi *ebi, |
| const struct stm32_fmc2_prop *prop, |
| int cs) |
| { |
| u32 cfgr = readl(ebi->io_base + FMC2_CFGR); |
| |
| if (cfgr & FMC2_CFGR_CCLKEN && !ebi->access_granted) |
| return -EACCES; |
| |
| return stm32_fmc2_ebi_check_sync_trans(ebi, prop, cs); |
| } |
| |
| 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 = 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 u32 stm32_fmc2_ebi_mp25_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 cfgr = readl(ebi->io_base + FMC2_CFGR); |
| u32 clk_period; |
| |
| if (cfgr & FMC2_CFGR_CCLKEN) { |
| clk_period = FIELD_GET(FMC2_CFGR_CLKDIV, cfgr) + 1; |
| } else { |
| u32 btr = readl(ebi->io_base + FMC2_BTR(cs)); |
| |
| 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; |
| case FMC2_REG_CFGR: |
| *reg = FMC2_CFGR; |
| 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_mp25_set_clk_period(struct stm32_fmc2_ebi *ebi, |
| const struct stm32_fmc2_prop *prop, |
| int cs, u32 setup) |
| { |
| u32 cfgr = readl(ebi->io_base + FMC2_CFGR); |
| u32 val; |
| |
| if (cfgr & FMC2_CFGR_CCLKEN) { |
| val = setup ? clamp_val(setup - 1, 1, FMC2_CFGR_CLKDIV_MAX) : 1; |
| val = FIELD_PREP(FMC2_CFGR_CLKDIV, val); |
| clrsetbits_le32(ebi->io_base + FMC2_CFGR, FMC2_CFGR_CLKDIV, val); |
| } else { |
| 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 int stm32_fmc2_ebi_mp25_set_max_low_pulse(struct stm32_fmc2_ebi *ebi, |
| const struct stm32_fmc2_prop *prop, |
| int cs, u32 setup) |
| { |
| u32 val; |
| |
| if (setup == FMC2_CSCOUNT_0) |
| val = FIELD_PREP(FMC2_BCR_CSCOUNT, FMC2_BCR_CSCOUNT_0); |
| else if (setup == FMC2_CSCOUNT_1) |
| val = FIELD_PREP(FMC2_BCR_CSCOUNT, FMC2_BCR_CSCOUNT_1); |
| else if (setup <= FMC2_CSCOUNT_64) |
| val = FIELD_PREP(FMC2_BCR_CSCOUNT, FMC2_BCR_CSCOUNT_64); |
| else |
| val = FIELD_PREP(FMC2_BCR_CSCOUNT, FMC2_BCR_CSCOUNT_256); |
| |
| clrsetbits_le32(ebi->io_base + FMC2_BCR(cs), |
| FMC2_BCR_CSCOUNT, 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 const struct stm32_fmc2_prop stm32_fmc2_mp25_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_CFGR, |
| .reg_mask = FMC2_CFGR_CCLKEN, |
| .check = stm32_fmc2_ebi_mp25_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_CFGR_CLKDIV_MAX + 1, |
| .check = stm32_fmc2_ebi_mp25_check_clk_period, |
| .calculate = stm32_fmc2_ebi_ns_to_clock_cycles, |
| .set = stm32_fmc2_ebi_mp25_set_clk_period, |
| }, |
| { |
| .name = "st,fmc2-ebi-cs-data-latency-ns", |
| .check = stm32_fmc2_ebi_check_sync_trans, |
| .calculate = stm32_fmc2_ebi_mp25_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_mp25_set_max_low_pulse, |
| }, |
| }; |
| |
| static int stm32_fmc2_ebi_mp25_check_rif(struct stm32_fmc2_ebi *ebi, u32 resource) |
| { |
| u32 seccfgr, cidcfgr, semcr; |
| int cid; |
| |
| if (resource >= FMC2_MAX_RESOURCES) |
| return -EINVAL; |
| |
| seccfgr = readl(ebi->io_base + FMC2_SECCFGR); |
| if (seccfgr & BIT(resource)) { |
| if (resource) |
| log_err("resource %d is configured as secure\n", |
| resource); |
| |
| return -EACCES; |
| } |
| |
| cidcfgr = readl(ebi->io_base + FMC2_CIDCFGR(resource)); |
| if (!(cidcfgr & FMC2_CIDCFGR_CFEN)) |
| /* CID filtering is turned off: access granted */ |
| return 0; |
| |
| if (!(cidcfgr & FMC2_CIDCFGR_SEMEN)) { |
| /* Static CID mode */ |
| cid = FIELD_GET(FMC2_CIDCFGR_SCID, cidcfgr); |
| if (cid != FMC2_CID1) { |
| if (resource) |
| log_err("static CID%d set for resource %d\n", |
| cid, resource); |
| |
| return -EACCES; |
| } |
| |
| return 0; |
| } |
| |
| /* Pass-list with semaphore mode */ |
| if (!(cidcfgr & FMC2_CIDCFGR_SEMWLC1)) { |
| if (resource) |
| log_err("CID1 is block-listed for resource %d\n", |
| resource); |
| |
| return -EACCES; |
| } |
| |
| semcr = readl(ebi->io_base + FMC2_SEMCR(resource)); |
| if (!(semcr & FMC2_SEMCR_SEM_MUTEX)) { |
| setbits_le32(ebi->io_base + FMC2_SEMCR(resource), |
| FMC2_SEMCR_SEM_MUTEX); |
| semcr = readl(ebi->io_base + FMC2_SEMCR(resource)); |
| } |
| |
| cid = FIELD_GET(FMC2_SEMCR_SEMCID, semcr); |
| if (cid != FMC2_CID1) { |
| if (resource) |
| log_err("resource %d is already used by CID%d\n", |
| resource, cid); |
| |
| return -EACCES; |
| } |
| |
| return 0; |
| } |
| |
| 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) { |
| log_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) { |
| log_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) { |
| log_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 int 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)) { |
| log_err("NWAIT signal connected to EBI and NAND controllers\n"); |
| return -EINVAL; |
| } |
| } |
| |
| return 0; |
| } |
| |
| static void stm32_fmc2_ebi_enable(struct stm32_fmc2_ebi *ebi) |
| { |
| if (!ebi->access_granted) |
| return; |
| |
| setbits_le32(ebi->io_base + ebi->data->fmc2_enable_reg, |
| ebi->data->fmc2_enable_bit); |
| } |
| |
| 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 < ebi->data->nb_child_props; i++) { |
| const struct stm32_fmc2_prop *p = &ebi->data->child_props[i]; |
| |
| ret = stm32_fmc2_ebi_parse_prop(ebi, node, p, cs); |
| if (ret) { |
| log_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) { |
| dev_err(dev, "could not retrieve reg property: %d\n", ret); |
| return ret; |
| } |
| |
| if (bank >= FMC2_MAX_BANKS) { |
| dev_err(dev, "invalid reg value: %d\n", bank); |
| return -EINVAL; |
| } |
| |
| if (ebi->bank_assigned & BIT(bank)) { |
| dev_err(dev, "bank already assigned: %d\n", bank); |
| return -EINVAL; |
| } |
| |
| if (ebi->data->check_rif) { |
| ret = ebi->data->check_rif(ebi, bank + 1); |
| if (ret) { |
| dev_err(dev, "bank access failed: %d\n", bank); |
| return ret; |
| } |
| } |
| |
| if (bank < FMC2_MAX_EBI_CE) { |
| ret = stm32_fmc2_ebi_setup_cs(ebi, child, bank); |
| if (ret) { |
| dev_err(dev, "setup chip select %d failed: %d\n", bank, ret); |
| return ret; |
| } |
| } |
| |
| ebi->bank_assigned |= BIT(bank); |
| child_found = true; |
| } |
| |
| if (!child_found) { |
| dev_warn(dev, "no subnodes found, disable the driver.\n"); |
| return -ENODEV; |
| } |
| |
| if (ebi->data->nwait_used_by_ctrls) { |
| ret = ebi->data->nwait_used_by_ctrls(ebi); |
| if (ret) |
| return ret; |
| } |
| |
| 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->data = (void *)dev_get_driver_data(dev); |
| if (!ebi->data) |
| return -EINVAL; |
| |
| 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); |
| } |
| |
| /* Check if CFGR register can be modified */ |
| ebi->access_granted = true; |
| if (ebi->data->check_rif) { |
| ret = ebi->data->check_rif(ebi, 0); |
| if (ret) { |
| ebi->access_granted = false; |
| |
| /* In case of CFGR is secure, just check that the FMC2 is enabled */ |
| if (readl(ebi->io_base + FMC2_SR) & FMC2_SR_ISOST) { |
| dev_err(dev, "FMC2 is not ready to be used.\n"); |
| return -EACCES; |
| } |
| } |
| } |
| |
| return stm32_fmc2_ebi_parse_dt(dev, ebi); |
| } |
| |
| static const struct stm32_fmc2_ebi_data stm32_fmc2_ebi_mp1_data = { |
| .child_props = stm32_fmc2_child_props, |
| .nb_child_props = ARRAY_SIZE(stm32_fmc2_child_props), |
| .fmc2_enable_reg = FMC2_BCR1, |
| .fmc2_enable_bit = FMC2_BCR1_FMC2EN, |
| .nwait_used_by_ctrls = stm32_fmc2_ebi_nwait_used_by_ctrls, |
| }; |
| |
| static const struct stm32_fmc2_ebi_data stm32_fmc2_ebi_mp25_data = { |
| .child_props = stm32_fmc2_mp25_child_props, |
| .nb_child_props = ARRAY_SIZE(stm32_fmc2_mp25_child_props), |
| .fmc2_enable_reg = FMC2_CFGR, |
| .fmc2_enable_bit = FMC2_CFGR_FMC2EN, |
| .check_rif = stm32_fmc2_ebi_mp25_check_rif, |
| }; |
| |
| static const struct udevice_id stm32_fmc2_ebi_match[] = { |
| { |
| .compatible = "st,stm32mp1-fmc2-ebi", |
| .data = (ulong)&stm32_fmc2_ebi_mp1_data, |
| }, |
| { |
| .compatible = "st,stm32mp25-fmc2-ebi", |
| .data = (ulong)&stm32_fmc2_ebi_mp25_data, |
| }, |
| { /* 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 = sizeof(struct stm32_fmc2_ebi), |
| .bind = dm_scan_fdt_dev, |
| }; |