mirror of
				https://xff.cz/git/u-boot/
				synced 2025-10-31 02:15:45 +01:00 
			
		
		
		
	The FMC2 revision 2 supports security and isolation compliant with the Resource Isolation Framework (RIF). From RIF point of view, the FMC2 is composed of several independent resources, listed below, which can be assigned to different security and compartment domains: - 0: Common FMC_CFGR register. - 1: EBI controller for Chip Select 1. - 2: EBI controller for Chip Select 2. - 3: EBI controller for Chip Select 3. - 4: EBI controller for Chip Select 4. - 5: NAND controller. Signed-off-by: Christophe Kerello <christophe.kerello@foss.st.com> Reviewed-by: Patrice Chotard <patrice.chotard@foss.st.com>
		
			
				
	
	
		
			1483 lines
		
	
	
		
			38 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
			
		
		
	
	
			1483 lines
		
	
	
		
			38 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
| // SPDX-License-Identifier: GPL-2.0+ OR BSD-3-Clause
 | |
| /*
 | |
|  * Copyright (C) STMicroelectronics 2020
 | |
|  */
 | |
| 
 | |
| #define LOG_CATEGORY UCLASS_NOP
 | |
| 
 | |
| #include <common.h>
 | |
| #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,
 | |
| };
 |