xref: /OK3568_Linux_fs/kernel/drivers/memory/stm32-fmc2-ebi.c (revision 4882a59341e53eb6f0b4789bf948001014eff981)
1*4882a593Smuzhiyun // SPDX-License-Identifier: GPL-2.0
2*4882a593Smuzhiyun /*
3*4882a593Smuzhiyun  * Copyright (C) STMicroelectronics 2020
4*4882a593Smuzhiyun  */
5*4882a593Smuzhiyun 
6*4882a593Smuzhiyun #include <linux/bitfield.h>
7*4882a593Smuzhiyun #include <linux/clk.h>
8*4882a593Smuzhiyun #include <linux/mfd/syscon.h>
9*4882a593Smuzhiyun #include <linux/module.h>
10*4882a593Smuzhiyun #include <linux/of_platform.h>
11*4882a593Smuzhiyun #include <linux/pinctrl/consumer.h>
12*4882a593Smuzhiyun #include <linux/regmap.h>
13*4882a593Smuzhiyun #include <linux/reset.h>
14*4882a593Smuzhiyun 
15*4882a593Smuzhiyun /* FMC2 Controller Registers */
16*4882a593Smuzhiyun #define FMC2_BCR1			0x0
17*4882a593Smuzhiyun #define FMC2_BTR1			0x4
18*4882a593Smuzhiyun #define FMC2_BCR(x)			((x) * 0x8 + FMC2_BCR1)
19*4882a593Smuzhiyun #define FMC2_BTR(x)			((x) * 0x8 + FMC2_BTR1)
20*4882a593Smuzhiyun #define FMC2_PCSCNTR			0x20
21*4882a593Smuzhiyun #define FMC2_BWTR1			0x104
22*4882a593Smuzhiyun #define FMC2_BWTR(x)			((x) * 0x8 + FMC2_BWTR1)
23*4882a593Smuzhiyun 
24*4882a593Smuzhiyun /* Register: FMC2_BCR1 */
25*4882a593Smuzhiyun #define FMC2_BCR1_CCLKEN		BIT(20)
26*4882a593Smuzhiyun #define FMC2_BCR1_FMC2EN		BIT(31)
27*4882a593Smuzhiyun 
28*4882a593Smuzhiyun /* Register: FMC2_BCRx */
29*4882a593Smuzhiyun #define FMC2_BCR_MBKEN			BIT(0)
30*4882a593Smuzhiyun #define FMC2_BCR_MUXEN			BIT(1)
31*4882a593Smuzhiyun #define FMC2_BCR_MTYP			GENMASK(3, 2)
32*4882a593Smuzhiyun #define FMC2_BCR_MWID			GENMASK(5, 4)
33*4882a593Smuzhiyun #define FMC2_BCR_FACCEN			BIT(6)
34*4882a593Smuzhiyun #define FMC2_BCR_BURSTEN		BIT(8)
35*4882a593Smuzhiyun #define FMC2_BCR_WAITPOL		BIT(9)
36*4882a593Smuzhiyun #define FMC2_BCR_WAITCFG		BIT(11)
37*4882a593Smuzhiyun #define FMC2_BCR_WREN			BIT(12)
38*4882a593Smuzhiyun #define FMC2_BCR_WAITEN			BIT(13)
39*4882a593Smuzhiyun #define FMC2_BCR_EXTMOD			BIT(14)
40*4882a593Smuzhiyun #define FMC2_BCR_ASYNCWAIT		BIT(15)
41*4882a593Smuzhiyun #define FMC2_BCR_CPSIZE			GENMASK(18, 16)
42*4882a593Smuzhiyun #define FMC2_BCR_CBURSTRW		BIT(19)
43*4882a593Smuzhiyun #define FMC2_BCR_NBLSET			GENMASK(23, 22)
44*4882a593Smuzhiyun 
45*4882a593Smuzhiyun /* Register: FMC2_BTRx/FMC2_BWTRx */
46*4882a593Smuzhiyun #define FMC2_BXTR_ADDSET		GENMASK(3, 0)
47*4882a593Smuzhiyun #define FMC2_BXTR_ADDHLD		GENMASK(7, 4)
48*4882a593Smuzhiyun #define FMC2_BXTR_DATAST		GENMASK(15, 8)
49*4882a593Smuzhiyun #define FMC2_BXTR_BUSTURN		GENMASK(19, 16)
50*4882a593Smuzhiyun #define FMC2_BTR_CLKDIV			GENMASK(23, 20)
51*4882a593Smuzhiyun #define FMC2_BTR_DATLAT			GENMASK(27, 24)
52*4882a593Smuzhiyun #define FMC2_BXTR_ACCMOD		GENMASK(29, 28)
53*4882a593Smuzhiyun #define FMC2_BXTR_DATAHLD		GENMASK(31, 30)
54*4882a593Smuzhiyun 
55*4882a593Smuzhiyun /* Register: FMC2_PCSCNTR */
56*4882a593Smuzhiyun #define FMC2_PCSCNTR_CSCOUNT		GENMASK(15, 0)
57*4882a593Smuzhiyun #define FMC2_PCSCNTR_CNTBEN(x)		BIT((x) + 16)
58*4882a593Smuzhiyun 
59*4882a593Smuzhiyun #define FMC2_MAX_EBI_CE			4
60*4882a593Smuzhiyun #define FMC2_MAX_BANKS			5
61*4882a593Smuzhiyun 
62*4882a593Smuzhiyun #define FMC2_BCR_CPSIZE_0		0x0
63*4882a593Smuzhiyun #define FMC2_BCR_CPSIZE_128		0x1
64*4882a593Smuzhiyun #define FMC2_BCR_CPSIZE_256		0x2
65*4882a593Smuzhiyun #define FMC2_BCR_CPSIZE_512		0x3
66*4882a593Smuzhiyun #define FMC2_BCR_CPSIZE_1024		0x4
67*4882a593Smuzhiyun 
68*4882a593Smuzhiyun #define FMC2_BCR_MWID_8			0x0
69*4882a593Smuzhiyun #define FMC2_BCR_MWID_16		0x1
70*4882a593Smuzhiyun 
71*4882a593Smuzhiyun #define FMC2_BCR_MTYP_SRAM		0x0
72*4882a593Smuzhiyun #define FMC2_BCR_MTYP_PSRAM		0x1
73*4882a593Smuzhiyun #define FMC2_BCR_MTYP_NOR		0x2
74*4882a593Smuzhiyun 
75*4882a593Smuzhiyun #define FMC2_BXTR_EXTMOD_A		0x0
76*4882a593Smuzhiyun #define FMC2_BXTR_EXTMOD_B		0x1
77*4882a593Smuzhiyun #define FMC2_BXTR_EXTMOD_C		0x2
78*4882a593Smuzhiyun #define FMC2_BXTR_EXTMOD_D		0x3
79*4882a593Smuzhiyun 
80*4882a593Smuzhiyun #define FMC2_BCR_NBLSET_MAX		0x3
81*4882a593Smuzhiyun #define FMC2_BXTR_ADDSET_MAX		0xf
82*4882a593Smuzhiyun #define FMC2_BXTR_ADDHLD_MAX		0xf
83*4882a593Smuzhiyun #define FMC2_BXTR_DATAST_MAX		0xff
84*4882a593Smuzhiyun #define FMC2_BXTR_BUSTURN_MAX		0xf
85*4882a593Smuzhiyun #define FMC2_BXTR_DATAHLD_MAX		0x3
86*4882a593Smuzhiyun #define FMC2_BTR_CLKDIV_MAX		0xf
87*4882a593Smuzhiyun #define FMC2_BTR_DATLAT_MAX		0xf
88*4882a593Smuzhiyun #define FMC2_PCSCNTR_CSCOUNT_MAX	0xff
89*4882a593Smuzhiyun 
90*4882a593Smuzhiyun enum stm32_fmc2_ebi_bank {
91*4882a593Smuzhiyun 	FMC2_EBI1 = 0,
92*4882a593Smuzhiyun 	FMC2_EBI2,
93*4882a593Smuzhiyun 	FMC2_EBI3,
94*4882a593Smuzhiyun 	FMC2_EBI4,
95*4882a593Smuzhiyun 	FMC2_NAND
96*4882a593Smuzhiyun };
97*4882a593Smuzhiyun 
98*4882a593Smuzhiyun enum stm32_fmc2_ebi_register_type {
99*4882a593Smuzhiyun 	FMC2_REG_BCR = 1,
100*4882a593Smuzhiyun 	FMC2_REG_BTR,
101*4882a593Smuzhiyun 	FMC2_REG_BWTR,
102*4882a593Smuzhiyun 	FMC2_REG_PCSCNTR
103*4882a593Smuzhiyun };
104*4882a593Smuzhiyun 
105*4882a593Smuzhiyun enum stm32_fmc2_ebi_transaction_type {
106*4882a593Smuzhiyun 	FMC2_ASYNC_MODE_1_SRAM = 0,
107*4882a593Smuzhiyun 	FMC2_ASYNC_MODE_1_PSRAM,
108*4882a593Smuzhiyun 	FMC2_ASYNC_MODE_A_SRAM,
109*4882a593Smuzhiyun 	FMC2_ASYNC_MODE_A_PSRAM,
110*4882a593Smuzhiyun 	FMC2_ASYNC_MODE_2_NOR,
111*4882a593Smuzhiyun 	FMC2_ASYNC_MODE_B_NOR,
112*4882a593Smuzhiyun 	FMC2_ASYNC_MODE_C_NOR,
113*4882a593Smuzhiyun 	FMC2_ASYNC_MODE_D_NOR,
114*4882a593Smuzhiyun 	FMC2_SYNC_READ_SYNC_WRITE_PSRAM,
115*4882a593Smuzhiyun 	FMC2_SYNC_READ_ASYNC_WRITE_PSRAM,
116*4882a593Smuzhiyun 	FMC2_SYNC_READ_SYNC_WRITE_NOR,
117*4882a593Smuzhiyun 	FMC2_SYNC_READ_ASYNC_WRITE_NOR
118*4882a593Smuzhiyun };
119*4882a593Smuzhiyun 
120*4882a593Smuzhiyun enum stm32_fmc2_ebi_buswidth {
121*4882a593Smuzhiyun 	FMC2_BUSWIDTH_8 = 8,
122*4882a593Smuzhiyun 	FMC2_BUSWIDTH_16 = 16
123*4882a593Smuzhiyun };
124*4882a593Smuzhiyun 
125*4882a593Smuzhiyun enum stm32_fmc2_ebi_cpsize {
126*4882a593Smuzhiyun 	FMC2_CPSIZE_0 = 0,
127*4882a593Smuzhiyun 	FMC2_CPSIZE_128 = 128,
128*4882a593Smuzhiyun 	FMC2_CPSIZE_256 = 256,
129*4882a593Smuzhiyun 	FMC2_CPSIZE_512 = 512,
130*4882a593Smuzhiyun 	FMC2_CPSIZE_1024 = 1024
131*4882a593Smuzhiyun };
132*4882a593Smuzhiyun 
133*4882a593Smuzhiyun struct stm32_fmc2_ebi {
134*4882a593Smuzhiyun 	struct device *dev;
135*4882a593Smuzhiyun 	struct clk *clk;
136*4882a593Smuzhiyun 	struct regmap *regmap;
137*4882a593Smuzhiyun 	u8 bank_assigned;
138*4882a593Smuzhiyun 
139*4882a593Smuzhiyun 	u32 bcr[FMC2_MAX_EBI_CE];
140*4882a593Smuzhiyun 	u32 btr[FMC2_MAX_EBI_CE];
141*4882a593Smuzhiyun 	u32 bwtr[FMC2_MAX_EBI_CE];
142*4882a593Smuzhiyun 	u32 pcscntr;
143*4882a593Smuzhiyun };
144*4882a593Smuzhiyun 
145*4882a593Smuzhiyun /*
146*4882a593Smuzhiyun  * struct stm32_fmc2_prop - STM32 FMC2 EBI property
147*4882a593Smuzhiyun  * @name: the device tree binding name of the property
148*4882a593Smuzhiyun  * @bprop: indicate that it is a boolean property
149*4882a593Smuzhiyun  * @mprop: indicate that it is a mandatory property
150*4882a593Smuzhiyun  * @reg_type: the register that have to be modified
151*4882a593Smuzhiyun  * @reg_mask: the bit that have to be modified in the selected register
152*4882a593Smuzhiyun  *            in case of it is a boolean property
153*4882a593Smuzhiyun  * @reset_val: the default value that have to be set in case the property
154*4882a593Smuzhiyun  *             has not been defined in the device tree
155*4882a593Smuzhiyun  * @check: this callback ckecks that the property is compliant with the
156*4882a593Smuzhiyun  *         transaction type selected
157*4882a593Smuzhiyun  * @calculate: this callback is called to calculate for exemple a timing
158*4882a593Smuzhiyun  *             set in nanoseconds in the device tree in clock cycles or in
159*4882a593Smuzhiyun  *             clock period
160*4882a593Smuzhiyun  * @set: this callback applies the values in the registers
161*4882a593Smuzhiyun  */
162*4882a593Smuzhiyun struct stm32_fmc2_prop {
163*4882a593Smuzhiyun 	const char *name;
164*4882a593Smuzhiyun 	bool bprop;
165*4882a593Smuzhiyun 	bool mprop;
166*4882a593Smuzhiyun 	int reg_type;
167*4882a593Smuzhiyun 	u32 reg_mask;
168*4882a593Smuzhiyun 	u32 reset_val;
169*4882a593Smuzhiyun 	int (*check)(struct stm32_fmc2_ebi *ebi,
170*4882a593Smuzhiyun 		     const struct stm32_fmc2_prop *prop, int cs);
171*4882a593Smuzhiyun 	u32 (*calculate)(struct stm32_fmc2_ebi *ebi, int cs, u32 setup);
172*4882a593Smuzhiyun 	int (*set)(struct stm32_fmc2_ebi *ebi,
173*4882a593Smuzhiyun 		   const struct stm32_fmc2_prop *prop,
174*4882a593Smuzhiyun 		   int cs, u32 setup);
175*4882a593Smuzhiyun };
176*4882a593Smuzhiyun 
stm32_fmc2_ebi_check_mux(struct stm32_fmc2_ebi * ebi,const struct stm32_fmc2_prop * prop,int cs)177*4882a593Smuzhiyun static int stm32_fmc2_ebi_check_mux(struct stm32_fmc2_ebi *ebi,
178*4882a593Smuzhiyun 				    const struct stm32_fmc2_prop *prop,
179*4882a593Smuzhiyun 				    int cs)
180*4882a593Smuzhiyun {
181*4882a593Smuzhiyun 	u32 bcr;
182*4882a593Smuzhiyun 
183*4882a593Smuzhiyun 	regmap_read(ebi->regmap, FMC2_BCR(cs), &bcr);
184*4882a593Smuzhiyun 
185*4882a593Smuzhiyun 	if (bcr & FMC2_BCR_MTYP)
186*4882a593Smuzhiyun 		return 0;
187*4882a593Smuzhiyun 
188*4882a593Smuzhiyun 	return -EINVAL;
189*4882a593Smuzhiyun }
190*4882a593Smuzhiyun 
stm32_fmc2_ebi_check_waitcfg(struct stm32_fmc2_ebi * ebi,const struct stm32_fmc2_prop * prop,int cs)191*4882a593Smuzhiyun static int stm32_fmc2_ebi_check_waitcfg(struct stm32_fmc2_ebi *ebi,
192*4882a593Smuzhiyun 					const struct stm32_fmc2_prop *prop,
193*4882a593Smuzhiyun 					int cs)
194*4882a593Smuzhiyun {
195*4882a593Smuzhiyun 	u32 bcr, val = FIELD_PREP(FMC2_BCR_MTYP, FMC2_BCR_MTYP_NOR);
196*4882a593Smuzhiyun 
197*4882a593Smuzhiyun 	regmap_read(ebi->regmap, FMC2_BCR(cs), &bcr);
198*4882a593Smuzhiyun 
199*4882a593Smuzhiyun 	if ((bcr & FMC2_BCR_MTYP) == val && bcr & FMC2_BCR_BURSTEN)
200*4882a593Smuzhiyun 		return 0;
201*4882a593Smuzhiyun 
202*4882a593Smuzhiyun 	return -EINVAL;
203*4882a593Smuzhiyun }
204*4882a593Smuzhiyun 
stm32_fmc2_ebi_check_sync_trans(struct stm32_fmc2_ebi * ebi,const struct stm32_fmc2_prop * prop,int cs)205*4882a593Smuzhiyun static int stm32_fmc2_ebi_check_sync_trans(struct stm32_fmc2_ebi *ebi,
206*4882a593Smuzhiyun 					   const struct stm32_fmc2_prop *prop,
207*4882a593Smuzhiyun 					   int cs)
208*4882a593Smuzhiyun {
209*4882a593Smuzhiyun 	u32 bcr;
210*4882a593Smuzhiyun 
211*4882a593Smuzhiyun 	regmap_read(ebi->regmap, FMC2_BCR(cs), &bcr);
212*4882a593Smuzhiyun 
213*4882a593Smuzhiyun 	if (bcr & FMC2_BCR_BURSTEN)
214*4882a593Smuzhiyun 		return 0;
215*4882a593Smuzhiyun 
216*4882a593Smuzhiyun 	return -EINVAL;
217*4882a593Smuzhiyun }
218*4882a593Smuzhiyun 
stm32_fmc2_ebi_check_async_trans(struct stm32_fmc2_ebi * ebi,const struct stm32_fmc2_prop * prop,int cs)219*4882a593Smuzhiyun static int stm32_fmc2_ebi_check_async_trans(struct stm32_fmc2_ebi *ebi,
220*4882a593Smuzhiyun 					    const struct stm32_fmc2_prop *prop,
221*4882a593Smuzhiyun 					    int cs)
222*4882a593Smuzhiyun {
223*4882a593Smuzhiyun 	u32 bcr;
224*4882a593Smuzhiyun 
225*4882a593Smuzhiyun 	regmap_read(ebi->regmap, FMC2_BCR(cs), &bcr);
226*4882a593Smuzhiyun 
227*4882a593Smuzhiyun 	if (!(bcr & FMC2_BCR_BURSTEN) || !(bcr & FMC2_BCR_CBURSTRW))
228*4882a593Smuzhiyun 		return 0;
229*4882a593Smuzhiyun 
230*4882a593Smuzhiyun 	return -EINVAL;
231*4882a593Smuzhiyun }
232*4882a593Smuzhiyun 
stm32_fmc2_ebi_check_cpsize(struct stm32_fmc2_ebi * ebi,const struct stm32_fmc2_prop * prop,int cs)233*4882a593Smuzhiyun static int stm32_fmc2_ebi_check_cpsize(struct stm32_fmc2_ebi *ebi,
234*4882a593Smuzhiyun 				       const struct stm32_fmc2_prop *prop,
235*4882a593Smuzhiyun 				       int cs)
236*4882a593Smuzhiyun {
237*4882a593Smuzhiyun 	u32 bcr, val = FIELD_PREP(FMC2_BCR_MTYP, FMC2_BCR_MTYP_PSRAM);
238*4882a593Smuzhiyun 
239*4882a593Smuzhiyun 	regmap_read(ebi->regmap, FMC2_BCR(cs), &bcr);
240*4882a593Smuzhiyun 
241*4882a593Smuzhiyun 	if ((bcr & FMC2_BCR_MTYP) == val && bcr & FMC2_BCR_BURSTEN)
242*4882a593Smuzhiyun 		return 0;
243*4882a593Smuzhiyun 
244*4882a593Smuzhiyun 	return -EINVAL;
245*4882a593Smuzhiyun }
246*4882a593Smuzhiyun 
stm32_fmc2_ebi_check_address_hold(struct stm32_fmc2_ebi * ebi,const struct stm32_fmc2_prop * prop,int cs)247*4882a593Smuzhiyun static int stm32_fmc2_ebi_check_address_hold(struct stm32_fmc2_ebi *ebi,
248*4882a593Smuzhiyun 					     const struct stm32_fmc2_prop *prop,
249*4882a593Smuzhiyun 					     int cs)
250*4882a593Smuzhiyun {
251*4882a593Smuzhiyun 	u32 bcr, bxtr, val = FIELD_PREP(FMC2_BXTR_ACCMOD, FMC2_BXTR_EXTMOD_D);
252*4882a593Smuzhiyun 
253*4882a593Smuzhiyun 	regmap_read(ebi->regmap, FMC2_BCR(cs), &bcr);
254*4882a593Smuzhiyun 	if (prop->reg_type == FMC2_REG_BWTR)
255*4882a593Smuzhiyun 		regmap_read(ebi->regmap, FMC2_BWTR(cs), &bxtr);
256*4882a593Smuzhiyun 	else
257*4882a593Smuzhiyun 		regmap_read(ebi->regmap, FMC2_BTR(cs), &bxtr);
258*4882a593Smuzhiyun 
259*4882a593Smuzhiyun 	if ((!(bcr & FMC2_BCR_BURSTEN) || !(bcr & FMC2_BCR_CBURSTRW)) &&
260*4882a593Smuzhiyun 	    ((bxtr & FMC2_BXTR_ACCMOD) == val || bcr & FMC2_BCR_MUXEN))
261*4882a593Smuzhiyun 		return 0;
262*4882a593Smuzhiyun 
263*4882a593Smuzhiyun 	return -EINVAL;
264*4882a593Smuzhiyun }
265*4882a593Smuzhiyun 
stm32_fmc2_ebi_check_clk_period(struct stm32_fmc2_ebi * ebi,const struct stm32_fmc2_prop * prop,int cs)266*4882a593Smuzhiyun static int stm32_fmc2_ebi_check_clk_period(struct stm32_fmc2_ebi *ebi,
267*4882a593Smuzhiyun 					   const struct stm32_fmc2_prop *prop,
268*4882a593Smuzhiyun 					   int cs)
269*4882a593Smuzhiyun {
270*4882a593Smuzhiyun 	u32 bcr, bcr1;
271*4882a593Smuzhiyun 
272*4882a593Smuzhiyun 	regmap_read(ebi->regmap, FMC2_BCR(cs), &bcr);
273*4882a593Smuzhiyun 	if (cs)
274*4882a593Smuzhiyun 		regmap_read(ebi->regmap, FMC2_BCR1, &bcr1);
275*4882a593Smuzhiyun 	else
276*4882a593Smuzhiyun 		bcr1 = bcr;
277*4882a593Smuzhiyun 
278*4882a593Smuzhiyun 	if (bcr & FMC2_BCR_BURSTEN && (!cs || !(bcr1 & FMC2_BCR1_CCLKEN)))
279*4882a593Smuzhiyun 		return 0;
280*4882a593Smuzhiyun 
281*4882a593Smuzhiyun 	return -EINVAL;
282*4882a593Smuzhiyun }
283*4882a593Smuzhiyun 
stm32_fmc2_ebi_check_cclk(struct stm32_fmc2_ebi * ebi,const struct stm32_fmc2_prop * prop,int cs)284*4882a593Smuzhiyun static int stm32_fmc2_ebi_check_cclk(struct stm32_fmc2_ebi *ebi,
285*4882a593Smuzhiyun 				     const struct stm32_fmc2_prop *prop,
286*4882a593Smuzhiyun 				     int cs)
287*4882a593Smuzhiyun {
288*4882a593Smuzhiyun 	if (cs)
289*4882a593Smuzhiyun 		return -EINVAL;
290*4882a593Smuzhiyun 
291*4882a593Smuzhiyun 	return stm32_fmc2_ebi_check_sync_trans(ebi, prop, cs);
292*4882a593Smuzhiyun }
293*4882a593Smuzhiyun 
stm32_fmc2_ebi_ns_to_clock_cycles(struct stm32_fmc2_ebi * ebi,int cs,u32 setup)294*4882a593Smuzhiyun static u32 stm32_fmc2_ebi_ns_to_clock_cycles(struct stm32_fmc2_ebi *ebi,
295*4882a593Smuzhiyun 					     int cs, u32 setup)
296*4882a593Smuzhiyun {
297*4882a593Smuzhiyun 	unsigned long hclk = clk_get_rate(ebi->clk);
298*4882a593Smuzhiyun 	unsigned long hclkp = NSEC_PER_SEC / (hclk / 1000);
299*4882a593Smuzhiyun 
300*4882a593Smuzhiyun 	return DIV_ROUND_UP(setup * 1000, hclkp);
301*4882a593Smuzhiyun }
302*4882a593Smuzhiyun 
stm32_fmc2_ebi_ns_to_clk_period(struct stm32_fmc2_ebi * ebi,int cs,u32 setup)303*4882a593Smuzhiyun static u32 stm32_fmc2_ebi_ns_to_clk_period(struct stm32_fmc2_ebi *ebi,
304*4882a593Smuzhiyun 					   int cs, u32 setup)
305*4882a593Smuzhiyun {
306*4882a593Smuzhiyun 	u32 nb_clk_cycles = stm32_fmc2_ebi_ns_to_clock_cycles(ebi, cs, setup);
307*4882a593Smuzhiyun 	u32 bcr, btr, clk_period;
308*4882a593Smuzhiyun 
309*4882a593Smuzhiyun 	regmap_read(ebi->regmap, FMC2_BCR1, &bcr);
310*4882a593Smuzhiyun 	if (bcr & FMC2_BCR1_CCLKEN || !cs)
311*4882a593Smuzhiyun 		regmap_read(ebi->regmap, FMC2_BTR1, &btr);
312*4882a593Smuzhiyun 	else
313*4882a593Smuzhiyun 		regmap_read(ebi->regmap, FMC2_BTR(cs), &btr);
314*4882a593Smuzhiyun 
315*4882a593Smuzhiyun 	clk_period = FIELD_GET(FMC2_BTR_CLKDIV, btr) + 1;
316*4882a593Smuzhiyun 
317*4882a593Smuzhiyun 	return DIV_ROUND_UP(nb_clk_cycles, clk_period);
318*4882a593Smuzhiyun }
319*4882a593Smuzhiyun 
stm32_fmc2_ebi_get_reg(int reg_type,int cs,u32 * reg)320*4882a593Smuzhiyun static int stm32_fmc2_ebi_get_reg(int reg_type, int cs, u32 *reg)
321*4882a593Smuzhiyun {
322*4882a593Smuzhiyun 	switch (reg_type) {
323*4882a593Smuzhiyun 	case FMC2_REG_BCR:
324*4882a593Smuzhiyun 		*reg = FMC2_BCR(cs);
325*4882a593Smuzhiyun 		break;
326*4882a593Smuzhiyun 	case FMC2_REG_BTR:
327*4882a593Smuzhiyun 		*reg = FMC2_BTR(cs);
328*4882a593Smuzhiyun 		break;
329*4882a593Smuzhiyun 	case FMC2_REG_BWTR:
330*4882a593Smuzhiyun 		*reg = FMC2_BWTR(cs);
331*4882a593Smuzhiyun 		break;
332*4882a593Smuzhiyun 	case FMC2_REG_PCSCNTR:
333*4882a593Smuzhiyun 		*reg = FMC2_PCSCNTR;
334*4882a593Smuzhiyun 		break;
335*4882a593Smuzhiyun 	default:
336*4882a593Smuzhiyun 		return -EINVAL;
337*4882a593Smuzhiyun 	}
338*4882a593Smuzhiyun 
339*4882a593Smuzhiyun 	return 0;
340*4882a593Smuzhiyun }
341*4882a593Smuzhiyun 
stm32_fmc2_ebi_set_bit_field(struct stm32_fmc2_ebi * ebi,const struct stm32_fmc2_prop * prop,int cs,u32 setup)342*4882a593Smuzhiyun static int stm32_fmc2_ebi_set_bit_field(struct stm32_fmc2_ebi *ebi,
343*4882a593Smuzhiyun 					const struct stm32_fmc2_prop *prop,
344*4882a593Smuzhiyun 					int cs, u32 setup)
345*4882a593Smuzhiyun {
346*4882a593Smuzhiyun 	u32 reg;
347*4882a593Smuzhiyun 	int ret;
348*4882a593Smuzhiyun 
349*4882a593Smuzhiyun 	ret = stm32_fmc2_ebi_get_reg(prop->reg_type, cs, &reg);
350*4882a593Smuzhiyun 	if (ret)
351*4882a593Smuzhiyun 		return ret;
352*4882a593Smuzhiyun 
353*4882a593Smuzhiyun 	regmap_update_bits(ebi->regmap, reg, prop->reg_mask,
354*4882a593Smuzhiyun 			   setup ? prop->reg_mask : 0);
355*4882a593Smuzhiyun 
356*4882a593Smuzhiyun 	return 0;
357*4882a593Smuzhiyun }
358*4882a593Smuzhiyun 
stm32_fmc2_ebi_set_trans_type(struct stm32_fmc2_ebi * ebi,const struct stm32_fmc2_prop * prop,int cs,u32 setup)359*4882a593Smuzhiyun static int stm32_fmc2_ebi_set_trans_type(struct stm32_fmc2_ebi *ebi,
360*4882a593Smuzhiyun 					 const struct stm32_fmc2_prop *prop,
361*4882a593Smuzhiyun 					 int cs, u32 setup)
362*4882a593Smuzhiyun {
363*4882a593Smuzhiyun 	u32 bcr_mask, bcr = FMC2_BCR_WREN;
364*4882a593Smuzhiyun 	u32 btr_mask, btr = 0;
365*4882a593Smuzhiyun 	u32 bwtr_mask, bwtr = 0;
366*4882a593Smuzhiyun 
367*4882a593Smuzhiyun 	bwtr_mask = FMC2_BXTR_ACCMOD;
368*4882a593Smuzhiyun 	btr_mask = FMC2_BXTR_ACCMOD;
369*4882a593Smuzhiyun 	bcr_mask = FMC2_BCR_MUXEN | FMC2_BCR_MTYP | FMC2_BCR_FACCEN |
370*4882a593Smuzhiyun 		   FMC2_BCR_WREN | FMC2_BCR_WAITEN | FMC2_BCR_BURSTEN |
371*4882a593Smuzhiyun 		   FMC2_BCR_EXTMOD | FMC2_BCR_CBURSTRW;
372*4882a593Smuzhiyun 
373*4882a593Smuzhiyun 	switch (setup) {
374*4882a593Smuzhiyun 	case FMC2_ASYNC_MODE_1_SRAM:
375*4882a593Smuzhiyun 		bcr |= FIELD_PREP(FMC2_BCR_MTYP, FMC2_BCR_MTYP_SRAM);
376*4882a593Smuzhiyun 		/*
377*4882a593Smuzhiyun 		 * MUXEN = 0, MTYP = 0, FACCEN = 0, BURSTEN = 0, WAITEN = 0,
378*4882a593Smuzhiyun 		 * WREN = 1, EXTMOD = 0, CBURSTRW = 0, ACCMOD = 0
379*4882a593Smuzhiyun 		 */
380*4882a593Smuzhiyun 		break;
381*4882a593Smuzhiyun 	case FMC2_ASYNC_MODE_1_PSRAM:
382*4882a593Smuzhiyun 		/*
383*4882a593Smuzhiyun 		 * MUXEN = 0, MTYP = 1, FACCEN = 0, BURSTEN = 0, WAITEN = 0,
384*4882a593Smuzhiyun 		 * WREN = 1, EXTMOD = 0, CBURSTRW = 0, ACCMOD = 0
385*4882a593Smuzhiyun 		 */
386*4882a593Smuzhiyun 		bcr |= FIELD_PREP(FMC2_BCR_MTYP, FMC2_BCR_MTYP_PSRAM);
387*4882a593Smuzhiyun 		break;
388*4882a593Smuzhiyun 	case FMC2_ASYNC_MODE_A_SRAM:
389*4882a593Smuzhiyun 		/*
390*4882a593Smuzhiyun 		 * MUXEN = 0, MTYP = 0, FACCEN = 0, BURSTEN = 0, WAITEN = 0,
391*4882a593Smuzhiyun 		 * WREN = 1, EXTMOD = 1, CBURSTRW = 0, ACCMOD = 0
392*4882a593Smuzhiyun 		 */
393*4882a593Smuzhiyun 		bcr |= FIELD_PREP(FMC2_BCR_MTYP, FMC2_BCR_MTYP_SRAM);
394*4882a593Smuzhiyun 		bcr |= FMC2_BCR_EXTMOD;
395*4882a593Smuzhiyun 		btr |= FIELD_PREP(FMC2_BXTR_ACCMOD, FMC2_BXTR_EXTMOD_A);
396*4882a593Smuzhiyun 		bwtr |= FIELD_PREP(FMC2_BXTR_ACCMOD, FMC2_BXTR_EXTMOD_A);
397*4882a593Smuzhiyun 		break;
398*4882a593Smuzhiyun 	case FMC2_ASYNC_MODE_A_PSRAM:
399*4882a593Smuzhiyun 		/*
400*4882a593Smuzhiyun 		 * MUXEN = 0, MTYP = 1, FACCEN = 0, BURSTEN = 0, WAITEN = 0,
401*4882a593Smuzhiyun 		 * WREN = 1, EXTMOD = 1, CBURSTRW = 0, ACCMOD = 0
402*4882a593Smuzhiyun 		 */
403*4882a593Smuzhiyun 		bcr |= FIELD_PREP(FMC2_BCR_MTYP, FMC2_BCR_MTYP_PSRAM);
404*4882a593Smuzhiyun 		bcr |= FMC2_BCR_EXTMOD;
405*4882a593Smuzhiyun 		btr |= FIELD_PREP(FMC2_BXTR_ACCMOD, FMC2_BXTR_EXTMOD_A);
406*4882a593Smuzhiyun 		bwtr |= FIELD_PREP(FMC2_BXTR_ACCMOD, FMC2_BXTR_EXTMOD_A);
407*4882a593Smuzhiyun 		break;
408*4882a593Smuzhiyun 	case FMC2_ASYNC_MODE_2_NOR:
409*4882a593Smuzhiyun 		/*
410*4882a593Smuzhiyun 		 * MUXEN = 0, MTYP = 2, FACCEN = 1, BURSTEN = 0, WAITEN = 0,
411*4882a593Smuzhiyun 		 * WREN = 1, EXTMOD = 0, CBURSTRW = 0, ACCMOD = 0
412*4882a593Smuzhiyun 		 */
413*4882a593Smuzhiyun 		bcr |= FIELD_PREP(FMC2_BCR_MTYP, FMC2_BCR_MTYP_NOR);
414*4882a593Smuzhiyun 		bcr |= FMC2_BCR_FACCEN;
415*4882a593Smuzhiyun 		break;
416*4882a593Smuzhiyun 	case FMC2_ASYNC_MODE_B_NOR:
417*4882a593Smuzhiyun 		/*
418*4882a593Smuzhiyun 		 * MUXEN = 0, MTYP = 2, FACCEN = 1, BURSTEN = 0, WAITEN = 0,
419*4882a593Smuzhiyun 		 * WREN = 1, EXTMOD = 1, CBURSTRW = 0, ACCMOD = 1
420*4882a593Smuzhiyun 		 */
421*4882a593Smuzhiyun 		bcr |= FIELD_PREP(FMC2_BCR_MTYP, FMC2_BCR_MTYP_NOR);
422*4882a593Smuzhiyun 		bcr |= FMC2_BCR_FACCEN | FMC2_BCR_EXTMOD;
423*4882a593Smuzhiyun 		btr |= FIELD_PREP(FMC2_BXTR_ACCMOD, FMC2_BXTR_EXTMOD_B);
424*4882a593Smuzhiyun 		bwtr |= FIELD_PREP(FMC2_BXTR_ACCMOD, FMC2_BXTR_EXTMOD_B);
425*4882a593Smuzhiyun 		break;
426*4882a593Smuzhiyun 	case FMC2_ASYNC_MODE_C_NOR:
427*4882a593Smuzhiyun 		/*
428*4882a593Smuzhiyun 		 * MUXEN = 0, MTYP = 2, FACCEN = 1, BURSTEN = 0, WAITEN = 0,
429*4882a593Smuzhiyun 		 * WREN = 1, EXTMOD = 1, CBURSTRW = 0, ACCMOD = 2
430*4882a593Smuzhiyun 		 */
431*4882a593Smuzhiyun 		bcr |= FIELD_PREP(FMC2_BCR_MTYP, FMC2_BCR_MTYP_NOR);
432*4882a593Smuzhiyun 		bcr |= FMC2_BCR_FACCEN | FMC2_BCR_EXTMOD;
433*4882a593Smuzhiyun 		btr |= FIELD_PREP(FMC2_BXTR_ACCMOD, FMC2_BXTR_EXTMOD_C);
434*4882a593Smuzhiyun 		bwtr |= FIELD_PREP(FMC2_BXTR_ACCMOD, FMC2_BXTR_EXTMOD_C);
435*4882a593Smuzhiyun 		break;
436*4882a593Smuzhiyun 	case FMC2_ASYNC_MODE_D_NOR:
437*4882a593Smuzhiyun 		/*
438*4882a593Smuzhiyun 		 * MUXEN = 0, MTYP = 2, FACCEN = 1, BURSTEN = 0, WAITEN = 0,
439*4882a593Smuzhiyun 		 * WREN = 1, EXTMOD = 1, CBURSTRW = 0, ACCMOD = 3
440*4882a593Smuzhiyun 		 */
441*4882a593Smuzhiyun 		bcr |= FIELD_PREP(FMC2_BCR_MTYP, FMC2_BCR_MTYP_NOR);
442*4882a593Smuzhiyun 		bcr |= FMC2_BCR_FACCEN | FMC2_BCR_EXTMOD;
443*4882a593Smuzhiyun 		btr |= FIELD_PREP(FMC2_BXTR_ACCMOD, FMC2_BXTR_EXTMOD_D);
444*4882a593Smuzhiyun 		bwtr |= FIELD_PREP(FMC2_BXTR_ACCMOD, FMC2_BXTR_EXTMOD_D);
445*4882a593Smuzhiyun 		break;
446*4882a593Smuzhiyun 	case FMC2_SYNC_READ_SYNC_WRITE_PSRAM:
447*4882a593Smuzhiyun 		/*
448*4882a593Smuzhiyun 		 * MUXEN = 0, MTYP = 1, FACCEN = 0, BURSTEN = 1, WAITEN = 0,
449*4882a593Smuzhiyun 		 * WREN = 1, EXTMOD = 0, CBURSTRW = 1, ACCMOD = 0
450*4882a593Smuzhiyun 		 */
451*4882a593Smuzhiyun 		bcr |= FIELD_PREP(FMC2_BCR_MTYP, FMC2_BCR_MTYP_PSRAM);
452*4882a593Smuzhiyun 		bcr |= FMC2_BCR_BURSTEN | FMC2_BCR_CBURSTRW;
453*4882a593Smuzhiyun 		break;
454*4882a593Smuzhiyun 	case FMC2_SYNC_READ_ASYNC_WRITE_PSRAM:
455*4882a593Smuzhiyun 		/*
456*4882a593Smuzhiyun 		 * MUXEN = 0, MTYP = 1, FACCEN = 0, BURSTEN = 1, WAITEN = 0,
457*4882a593Smuzhiyun 		 * WREN = 1, EXTMOD = 0, CBURSTRW = 0, ACCMOD = 0
458*4882a593Smuzhiyun 		 */
459*4882a593Smuzhiyun 		bcr |= FIELD_PREP(FMC2_BCR_MTYP, FMC2_BCR_MTYP_PSRAM);
460*4882a593Smuzhiyun 		bcr |= FMC2_BCR_BURSTEN;
461*4882a593Smuzhiyun 		break;
462*4882a593Smuzhiyun 	case FMC2_SYNC_READ_SYNC_WRITE_NOR:
463*4882a593Smuzhiyun 		/*
464*4882a593Smuzhiyun 		 * MUXEN = 0, MTYP = 2, FACCEN = 1, BURSTEN = 1, WAITEN = 0,
465*4882a593Smuzhiyun 		 * WREN = 1, EXTMOD = 0, CBURSTRW = 1, ACCMOD = 0
466*4882a593Smuzhiyun 		 */
467*4882a593Smuzhiyun 		bcr |= FIELD_PREP(FMC2_BCR_MTYP, FMC2_BCR_MTYP_NOR);
468*4882a593Smuzhiyun 		bcr |= FMC2_BCR_FACCEN | FMC2_BCR_BURSTEN | FMC2_BCR_CBURSTRW;
469*4882a593Smuzhiyun 		break;
470*4882a593Smuzhiyun 	case FMC2_SYNC_READ_ASYNC_WRITE_NOR:
471*4882a593Smuzhiyun 		/*
472*4882a593Smuzhiyun 		 * MUXEN = 0, MTYP = 2, FACCEN = 1, BURSTEN = 1, WAITEN = 0,
473*4882a593Smuzhiyun 		 * WREN = 1, EXTMOD = 0, CBURSTRW = 0, ACCMOD = 0
474*4882a593Smuzhiyun 		 */
475*4882a593Smuzhiyun 		bcr |= FIELD_PREP(FMC2_BCR_MTYP, FMC2_BCR_MTYP_NOR);
476*4882a593Smuzhiyun 		bcr |= FMC2_BCR_FACCEN | FMC2_BCR_BURSTEN;
477*4882a593Smuzhiyun 		break;
478*4882a593Smuzhiyun 	default:
479*4882a593Smuzhiyun 		/* Type of transaction not supported */
480*4882a593Smuzhiyun 		return -EINVAL;
481*4882a593Smuzhiyun 	}
482*4882a593Smuzhiyun 
483*4882a593Smuzhiyun 	if (bcr & FMC2_BCR_EXTMOD)
484*4882a593Smuzhiyun 		regmap_update_bits(ebi->regmap, FMC2_BWTR(cs),
485*4882a593Smuzhiyun 				   bwtr_mask, bwtr);
486*4882a593Smuzhiyun 	regmap_update_bits(ebi->regmap, FMC2_BTR(cs), btr_mask, btr);
487*4882a593Smuzhiyun 	regmap_update_bits(ebi->regmap, FMC2_BCR(cs), bcr_mask, bcr);
488*4882a593Smuzhiyun 
489*4882a593Smuzhiyun 	return 0;
490*4882a593Smuzhiyun }
491*4882a593Smuzhiyun 
stm32_fmc2_ebi_set_buswidth(struct stm32_fmc2_ebi * ebi,const struct stm32_fmc2_prop * prop,int cs,u32 setup)492*4882a593Smuzhiyun static int stm32_fmc2_ebi_set_buswidth(struct stm32_fmc2_ebi *ebi,
493*4882a593Smuzhiyun 				       const struct stm32_fmc2_prop *prop,
494*4882a593Smuzhiyun 				       int cs, u32 setup)
495*4882a593Smuzhiyun {
496*4882a593Smuzhiyun 	u32 val;
497*4882a593Smuzhiyun 
498*4882a593Smuzhiyun 	switch (setup) {
499*4882a593Smuzhiyun 	case FMC2_BUSWIDTH_8:
500*4882a593Smuzhiyun 		val = FIELD_PREP(FMC2_BCR_MWID, FMC2_BCR_MWID_8);
501*4882a593Smuzhiyun 		break;
502*4882a593Smuzhiyun 	case FMC2_BUSWIDTH_16:
503*4882a593Smuzhiyun 		val = FIELD_PREP(FMC2_BCR_MWID, FMC2_BCR_MWID_16);
504*4882a593Smuzhiyun 		break;
505*4882a593Smuzhiyun 	default:
506*4882a593Smuzhiyun 		/* Buswidth not supported */
507*4882a593Smuzhiyun 		return -EINVAL;
508*4882a593Smuzhiyun 	}
509*4882a593Smuzhiyun 
510*4882a593Smuzhiyun 	regmap_update_bits(ebi->regmap, FMC2_BCR(cs), FMC2_BCR_MWID, val);
511*4882a593Smuzhiyun 
512*4882a593Smuzhiyun 	return 0;
513*4882a593Smuzhiyun }
514*4882a593Smuzhiyun 
stm32_fmc2_ebi_set_cpsize(struct stm32_fmc2_ebi * ebi,const struct stm32_fmc2_prop * prop,int cs,u32 setup)515*4882a593Smuzhiyun static int stm32_fmc2_ebi_set_cpsize(struct stm32_fmc2_ebi *ebi,
516*4882a593Smuzhiyun 				     const struct stm32_fmc2_prop *prop,
517*4882a593Smuzhiyun 				     int cs, u32 setup)
518*4882a593Smuzhiyun {
519*4882a593Smuzhiyun 	u32 val;
520*4882a593Smuzhiyun 
521*4882a593Smuzhiyun 	switch (setup) {
522*4882a593Smuzhiyun 	case FMC2_CPSIZE_0:
523*4882a593Smuzhiyun 		val = FIELD_PREP(FMC2_BCR_CPSIZE, FMC2_BCR_CPSIZE_0);
524*4882a593Smuzhiyun 		break;
525*4882a593Smuzhiyun 	case FMC2_CPSIZE_128:
526*4882a593Smuzhiyun 		val = FIELD_PREP(FMC2_BCR_CPSIZE, FMC2_BCR_CPSIZE_128);
527*4882a593Smuzhiyun 		break;
528*4882a593Smuzhiyun 	case FMC2_CPSIZE_256:
529*4882a593Smuzhiyun 		val = FIELD_PREP(FMC2_BCR_CPSIZE, FMC2_BCR_CPSIZE_256);
530*4882a593Smuzhiyun 		break;
531*4882a593Smuzhiyun 	case FMC2_CPSIZE_512:
532*4882a593Smuzhiyun 		val = FIELD_PREP(FMC2_BCR_CPSIZE, FMC2_BCR_CPSIZE_512);
533*4882a593Smuzhiyun 		break;
534*4882a593Smuzhiyun 	case FMC2_CPSIZE_1024:
535*4882a593Smuzhiyun 		val = FIELD_PREP(FMC2_BCR_CPSIZE, FMC2_BCR_CPSIZE_1024);
536*4882a593Smuzhiyun 		break;
537*4882a593Smuzhiyun 	default:
538*4882a593Smuzhiyun 		/* Cpsize not supported */
539*4882a593Smuzhiyun 		return -EINVAL;
540*4882a593Smuzhiyun 	}
541*4882a593Smuzhiyun 
542*4882a593Smuzhiyun 	regmap_update_bits(ebi->regmap, FMC2_BCR(cs), FMC2_BCR_CPSIZE, val);
543*4882a593Smuzhiyun 
544*4882a593Smuzhiyun 	return 0;
545*4882a593Smuzhiyun }
546*4882a593Smuzhiyun 
stm32_fmc2_ebi_set_bl_setup(struct stm32_fmc2_ebi * ebi,const struct stm32_fmc2_prop * prop,int cs,u32 setup)547*4882a593Smuzhiyun static int stm32_fmc2_ebi_set_bl_setup(struct stm32_fmc2_ebi *ebi,
548*4882a593Smuzhiyun 				       const struct stm32_fmc2_prop *prop,
549*4882a593Smuzhiyun 				       int cs, u32 setup)
550*4882a593Smuzhiyun {
551*4882a593Smuzhiyun 	u32 val;
552*4882a593Smuzhiyun 
553*4882a593Smuzhiyun 	val = min_t(u32, setup, FMC2_BCR_NBLSET_MAX);
554*4882a593Smuzhiyun 	val = FIELD_PREP(FMC2_BCR_NBLSET, val);
555*4882a593Smuzhiyun 	regmap_update_bits(ebi->regmap, FMC2_BCR(cs), FMC2_BCR_NBLSET, val);
556*4882a593Smuzhiyun 
557*4882a593Smuzhiyun 	return 0;
558*4882a593Smuzhiyun }
559*4882a593Smuzhiyun 
stm32_fmc2_ebi_set_address_setup(struct stm32_fmc2_ebi * ebi,const struct stm32_fmc2_prop * prop,int cs,u32 setup)560*4882a593Smuzhiyun static int stm32_fmc2_ebi_set_address_setup(struct stm32_fmc2_ebi *ebi,
561*4882a593Smuzhiyun 					    const struct stm32_fmc2_prop *prop,
562*4882a593Smuzhiyun 					    int cs, u32 setup)
563*4882a593Smuzhiyun {
564*4882a593Smuzhiyun 	u32 bcr, bxtr, reg;
565*4882a593Smuzhiyun 	u32 val = FIELD_PREP(FMC2_BXTR_ACCMOD, FMC2_BXTR_EXTMOD_D);
566*4882a593Smuzhiyun 	int ret;
567*4882a593Smuzhiyun 
568*4882a593Smuzhiyun 	ret = stm32_fmc2_ebi_get_reg(prop->reg_type, cs, &reg);
569*4882a593Smuzhiyun 	if (ret)
570*4882a593Smuzhiyun 		return ret;
571*4882a593Smuzhiyun 
572*4882a593Smuzhiyun 	regmap_read(ebi->regmap, FMC2_BCR(cs), &bcr);
573*4882a593Smuzhiyun 	if (prop->reg_type == FMC2_REG_BWTR)
574*4882a593Smuzhiyun 		regmap_read(ebi->regmap, FMC2_BWTR(cs), &bxtr);
575*4882a593Smuzhiyun 	else
576*4882a593Smuzhiyun 		regmap_read(ebi->regmap, FMC2_BTR(cs), &bxtr);
577*4882a593Smuzhiyun 
578*4882a593Smuzhiyun 	if ((bxtr & FMC2_BXTR_ACCMOD) == val || bcr & FMC2_BCR_MUXEN)
579*4882a593Smuzhiyun 		val = clamp_val(setup, 1, FMC2_BXTR_ADDSET_MAX);
580*4882a593Smuzhiyun 	else
581*4882a593Smuzhiyun 		val = min_t(u32, setup, FMC2_BXTR_ADDSET_MAX);
582*4882a593Smuzhiyun 	val = FIELD_PREP(FMC2_BXTR_ADDSET, val);
583*4882a593Smuzhiyun 	regmap_update_bits(ebi->regmap, reg, FMC2_BXTR_ADDSET, val);
584*4882a593Smuzhiyun 
585*4882a593Smuzhiyun 	return 0;
586*4882a593Smuzhiyun }
587*4882a593Smuzhiyun 
stm32_fmc2_ebi_set_address_hold(struct stm32_fmc2_ebi * ebi,const struct stm32_fmc2_prop * prop,int cs,u32 setup)588*4882a593Smuzhiyun static int stm32_fmc2_ebi_set_address_hold(struct stm32_fmc2_ebi *ebi,
589*4882a593Smuzhiyun 					   const struct stm32_fmc2_prop *prop,
590*4882a593Smuzhiyun 					   int cs, u32 setup)
591*4882a593Smuzhiyun {
592*4882a593Smuzhiyun 	u32 val, reg;
593*4882a593Smuzhiyun 	int ret;
594*4882a593Smuzhiyun 
595*4882a593Smuzhiyun 	ret = stm32_fmc2_ebi_get_reg(prop->reg_type, cs, &reg);
596*4882a593Smuzhiyun 	if (ret)
597*4882a593Smuzhiyun 		return ret;
598*4882a593Smuzhiyun 
599*4882a593Smuzhiyun 	val = clamp_val(setup, 1, FMC2_BXTR_ADDHLD_MAX);
600*4882a593Smuzhiyun 	val = FIELD_PREP(FMC2_BXTR_ADDHLD, val);
601*4882a593Smuzhiyun 	regmap_update_bits(ebi->regmap, reg, FMC2_BXTR_ADDHLD, val);
602*4882a593Smuzhiyun 
603*4882a593Smuzhiyun 	return 0;
604*4882a593Smuzhiyun }
605*4882a593Smuzhiyun 
stm32_fmc2_ebi_set_data_setup(struct stm32_fmc2_ebi * ebi,const struct stm32_fmc2_prop * prop,int cs,u32 setup)606*4882a593Smuzhiyun static int stm32_fmc2_ebi_set_data_setup(struct stm32_fmc2_ebi *ebi,
607*4882a593Smuzhiyun 					 const struct stm32_fmc2_prop *prop,
608*4882a593Smuzhiyun 					 int cs, u32 setup)
609*4882a593Smuzhiyun {
610*4882a593Smuzhiyun 	u32 val, reg;
611*4882a593Smuzhiyun 	int ret;
612*4882a593Smuzhiyun 
613*4882a593Smuzhiyun 	ret = stm32_fmc2_ebi_get_reg(prop->reg_type, cs, &reg);
614*4882a593Smuzhiyun 	if (ret)
615*4882a593Smuzhiyun 		return ret;
616*4882a593Smuzhiyun 
617*4882a593Smuzhiyun 	val = clamp_val(setup, 1, FMC2_BXTR_DATAST_MAX);
618*4882a593Smuzhiyun 	val = FIELD_PREP(FMC2_BXTR_DATAST, val);
619*4882a593Smuzhiyun 	regmap_update_bits(ebi->regmap, reg, FMC2_BXTR_DATAST, val);
620*4882a593Smuzhiyun 
621*4882a593Smuzhiyun 	return 0;
622*4882a593Smuzhiyun }
623*4882a593Smuzhiyun 
stm32_fmc2_ebi_set_bus_turnaround(struct stm32_fmc2_ebi * ebi,const struct stm32_fmc2_prop * prop,int cs,u32 setup)624*4882a593Smuzhiyun static int stm32_fmc2_ebi_set_bus_turnaround(struct stm32_fmc2_ebi *ebi,
625*4882a593Smuzhiyun 					     const struct stm32_fmc2_prop *prop,
626*4882a593Smuzhiyun 					     int cs, u32 setup)
627*4882a593Smuzhiyun {
628*4882a593Smuzhiyun 	u32 val, reg;
629*4882a593Smuzhiyun 	int ret;
630*4882a593Smuzhiyun 
631*4882a593Smuzhiyun 	ret = stm32_fmc2_ebi_get_reg(prop->reg_type, cs, &reg);
632*4882a593Smuzhiyun 	if (ret)
633*4882a593Smuzhiyun 		return ret;
634*4882a593Smuzhiyun 
635*4882a593Smuzhiyun 	val = setup ? min_t(u32, setup - 1, FMC2_BXTR_BUSTURN_MAX) : 0;
636*4882a593Smuzhiyun 	val = FIELD_PREP(FMC2_BXTR_BUSTURN, val);
637*4882a593Smuzhiyun 	regmap_update_bits(ebi->regmap, reg, FMC2_BXTR_BUSTURN, val);
638*4882a593Smuzhiyun 
639*4882a593Smuzhiyun 	return 0;
640*4882a593Smuzhiyun }
641*4882a593Smuzhiyun 
stm32_fmc2_ebi_set_data_hold(struct stm32_fmc2_ebi * ebi,const struct stm32_fmc2_prop * prop,int cs,u32 setup)642*4882a593Smuzhiyun static int stm32_fmc2_ebi_set_data_hold(struct stm32_fmc2_ebi *ebi,
643*4882a593Smuzhiyun 					const struct stm32_fmc2_prop *prop,
644*4882a593Smuzhiyun 					int cs, u32 setup)
645*4882a593Smuzhiyun {
646*4882a593Smuzhiyun 	u32 val, reg;
647*4882a593Smuzhiyun 	int ret;
648*4882a593Smuzhiyun 
649*4882a593Smuzhiyun 	ret = stm32_fmc2_ebi_get_reg(prop->reg_type, cs, &reg);
650*4882a593Smuzhiyun 	if (ret)
651*4882a593Smuzhiyun 		return ret;
652*4882a593Smuzhiyun 
653*4882a593Smuzhiyun 	if (prop->reg_type == FMC2_REG_BWTR)
654*4882a593Smuzhiyun 		val = setup ? min_t(u32, setup - 1, FMC2_BXTR_DATAHLD_MAX) : 0;
655*4882a593Smuzhiyun 	else
656*4882a593Smuzhiyun 		val = min_t(u32, setup, FMC2_BXTR_DATAHLD_MAX);
657*4882a593Smuzhiyun 	val = FIELD_PREP(FMC2_BXTR_DATAHLD, val);
658*4882a593Smuzhiyun 	regmap_update_bits(ebi->regmap, reg, FMC2_BXTR_DATAHLD, val);
659*4882a593Smuzhiyun 
660*4882a593Smuzhiyun 	return 0;
661*4882a593Smuzhiyun }
662*4882a593Smuzhiyun 
stm32_fmc2_ebi_set_clk_period(struct stm32_fmc2_ebi * ebi,const struct stm32_fmc2_prop * prop,int cs,u32 setup)663*4882a593Smuzhiyun static int stm32_fmc2_ebi_set_clk_period(struct stm32_fmc2_ebi *ebi,
664*4882a593Smuzhiyun 					 const struct stm32_fmc2_prop *prop,
665*4882a593Smuzhiyun 					 int cs, u32 setup)
666*4882a593Smuzhiyun {
667*4882a593Smuzhiyun 	u32 val;
668*4882a593Smuzhiyun 
669*4882a593Smuzhiyun 	val = setup ? clamp_val(setup - 1, 1, FMC2_BTR_CLKDIV_MAX) : 1;
670*4882a593Smuzhiyun 	val = FIELD_PREP(FMC2_BTR_CLKDIV, val);
671*4882a593Smuzhiyun 	regmap_update_bits(ebi->regmap, FMC2_BTR(cs), FMC2_BTR_CLKDIV, val);
672*4882a593Smuzhiyun 
673*4882a593Smuzhiyun 	return 0;
674*4882a593Smuzhiyun }
675*4882a593Smuzhiyun 
stm32_fmc2_ebi_set_data_latency(struct stm32_fmc2_ebi * ebi,const struct stm32_fmc2_prop * prop,int cs,u32 setup)676*4882a593Smuzhiyun static int stm32_fmc2_ebi_set_data_latency(struct stm32_fmc2_ebi *ebi,
677*4882a593Smuzhiyun 					   const struct stm32_fmc2_prop *prop,
678*4882a593Smuzhiyun 					   int cs, u32 setup)
679*4882a593Smuzhiyun {
680*4882a593Smuzhiyun 	u32 val;
681*4882a593Smuzhiyun 
682*4882a593Smuzhiyun 	val = setup > 1 ? min_t(u32, setup - 2, FMC2_BTR_DATLAT_MAX) : 0;
683*4882a593Smuzhiyun 	val = FIELD_PREP(FMC2_BTR_DATLAT, val);
684*4882a593Smuzhiyun 	regmap_update_bits(ebi->regmap, FMC2_BTR(cs), FMC2_BTR_DATLAT, val);
685*4882a593Smuzhiyun 
686*4882a593Smuzhiyun 	return 0;
687*4882a593Smuzhiyun }
688*4882a593Smuzhiyun 
stm32_fmc2_ebi_set_max_low_pulse(struct stm32_fmc2_ebi * ebi,const struct stm32_fmc2_prop * prop,int cs,u32 setup)689*4882a593Smuzhiyun static int stm32_fmc2_ebi_set_max_low_pulse(struct stm32_fmc2_ebi *ebi,
690*4882a593Smuzhiyun 					    const struct stm32_fmc2_prop *prop,
691*4882a593Smuzhiyun 					    int cs, u32 setup)
692*4882a593Smuzhiyun {
693*4882a593Smuzhiyun 	u32 old_val, new_val, pcscntr;
694*4882a593Smuzhiyun 
695*4882a593Smuzhiyun 	if (setup < 1)
696*4882a593Smuzhiyun 		return 0;
697*4882a593Smuzhiyun 
698*4882a593Smuzhiyun 	regmap_read(ebi->regmap, FMC2_PCSCNTR, &pcscntr);
699*4882a593Smuzhiyun 
700*4882a593Smuzhiyun 	/* Enable counter for the bank */
701*4882a593Smuzhiyun 	regmap_update_bits(ebi->regmap, FMC2_PCSCNTR,
702*4882a593Smuzhiyun 			   FMC2_PCSCNTR_CNTBEN(cs),
703*4882a593Smuzhiyun 			   FMC2_PCSCNTR_CNTBEN(cs));
704*4882a593Smuzhiyun 
705*4882a593Smuzhiyun 	new_val = min_t(u32, setup - 1, FMC2_PCSCNTR_CSCOUNT_MAX);
706*4882a593Smuzhiyun 	old_val = FIELD_GET(FMC2_PCSCNTR_CSCOUNT, pcscntr);
707*4882a593Smuzhiyun 	if (old_val && new_val > old_val)
708*4882a593Smuzhiyun 		/* Keep current counter value */
709*4882a593Smuzhiyun 		return 0;
710*4882a593Smuzhiyun 
711*4882a593Smuzhiyun 	new_val = FIELD_PREP(FMC2_PCSCNTR_CSCOUNT, new_val);
712*4882a593Smuzhiyun 	regmap_update_bits(ebi->regmap, FMC2_PCSCNTR,
713*4882a593Smuzhiyun 			   FMC2_PCSCNTR_CSCOUNT, new_val);
714*4882a593Smuzhiyun 
715*4882a593Smuzhiyun 	return 0;
716*4882a593Smuzhiyun }
717*4882a593Smuzhiyun 
718*4882a593Smuzhiyun static const struct stm32_fmc2_prop stm32_fmc2_child_props[] = {
719*4882a593Smuzhiyun 	/* st,fmc2-ebi-cs-trans-type must be the first property */
720*4882a593Smuzhiyun 	{
721*4882a593Smuzhiyun 		.name = "st,fmc2-ebi-cs-transaction-type",
722*4882a593Smuzhiyun 		.mprop = true,
723*4882a593Smuzhiyun 		.set = stm32_fmc2_ebi_set_trans_type,
724*4882a593Smuzhiyun 	},
725*4882a593Smuzhiyun 	{
726*4882a593Smuzhiyun 		.name = "st,fmc2-ebi-cs-cclk-enable",
727*4882a593Smuzhiyun 		.bprop = true,
728*4882a593Smuzhiyun 		.reg_type = FMC2_REG_BCR,
729*4882a593Smuzhiyun 		.reg_mask = FMC2_BCR1_CCLKEN,
730*4882a593Smuzhiyun 		.check = stm32_fmc2_ebi_check_cclk,
731*4882a593Smuzhiyun 		.set = stm32_fmc2_ebi_set_bit_field,
732*4882a593Smuzhiyun 	},
733*4882a593Smuzhiyun 	{
734*4882a593Smuzhiyun 		.name = "st,fmc2-ebi-cs-mux-enable",
735*4882a593Smuzhiyun 		.bprop = true,
736*4882a593Smuzhiyun 		.reg_type = FMC2_REG_BCR,
737*4882a593Smuzhiyun 		.reg_mask = FMC2_BCR_MUXEN,
738*4882a593Smuzhiyun 		.check = stm32_fmc2_ebi_check_mux,
739*4882a593Smuzhiyun 		.set = stm32_fmc2_ebi_set_bit_field,
740*4882a593Smuzhiyun 	},
741*4882a593Smuzhiyun 	{
742*4882a593Smuzhiyun 		.name = "st,fmc2-ebi-cs-buswidth",
743*4882a593Smuzhiyun 		.reset_val = FMC2_BUSWIDTH_16,
744*4882a593Smuzhiyun 		.set = stm32_fmc2_ebi_set_buswidth,
745*4882a593Smuzhiyun 	},
746*4882a593Smuzhiyun 	{
747*4882a593Smuzhiyun 		.name = "st,fmc2-ebi-cs-waitpol-high",
748*4882a593Smuzhiyun 		.bprop = true,
749*4882a593Smuzhiyun 		.reg_type = FMC2_REG_BCR,
750*4882a593Smuzhiyun 		.reg_mask = FMC2_BCR_WAITPOL,
751*4882a593Smuzhiyun 		.set = stm32_fmc2_ebi_set_bit_field,
752*4882a593Smuzhiyun 	},
753*4882a593Smuzhiyun 	{
754*4882a593Smuzhiyun 		.name = "st,fmc2-ebi-cs-waitcfg-enable",
755*4882a593Smuzhiyun 		.bprop = true,
756*4882a593Smuzhiyun 		.reg_type = FMC2_REG_BCR,
757*4882a593Smuzhiyun 		.reg_mask = FMC2_BCR_WAITCFG,
758*4882a593Smuzhiyun 		.check = stm32_fmc2_ebi_check_waitcfg,
759*4882a593Smuzhiyun 		.set = stm32_fmc2_ebi_set_bit_field,
760*4882a593Smuzhiyun 	},
761*4882a593Smuzhiyun 	{
762*4882a593Smuzhiyun 		.name = "st,fmc2-ebi-cs-wait-enable",
763*4882a593Smuzhiyun 		.bprop = true,
764*4882a593Smuzhiyun 		.reg_type = FMC2_REG_BCR,
765*4882a593Smuzhiyun 		.reg_mask = FMC2_BCR_WAITEN,
766*4882a593Smuzhiyun 		.check = stm32_fmc2_ebi_check_sync_trans,
767*4882a593Smuzhiyun 		.set = stm32_fmc2_ebi_set_bit_field,
768*4882a593Smuzhiyun 	},
769*4882a593Smuzhiyun 	{
770*4882a593Smuzhiyun 		.name = "st,fmc2-ebi-cs-asyncwait-enable",
771*4882a593Smuzhiyun 		.bprop = true,
772*4882a593Smuzhiyun 		.reg_type = FMC2_REG_BCR,
773*4882a593Smuzhiyun 		.reg_mask = FMC2_BCR_ASYNCWAIT,
774*4882a593Smuzhiyun 		.check = stm32_fmc2_ebi_check_async_trans,
775*4882a593Smuzhiyun 		.set = stm32_fmc2_ebi_set_bit_field,
776*4882a593Smuzhiyun 	},
777*4882a593Smuzhiyun 	{
778*4882a593Smuzhiyun 		.name = "st,fmc2-ebi-cs-cpsize",
779*4882a593Smuzhiyun 		.check = stm32_fmc2_ebi_check_cpsize,
780*4882a593Smuzhiyun 		.set = stm32_fmc2_ebi_set_cpsize,
781*4882a593Smuzhiyun 	},
782*4882a593Smuzhiyun 	{
783*4882a593Smuzhiyun 		.name = "st,fmc2-ebi-cs-byte-lane-setup-ns",
784*4882a593Smuzhiyun 		.calculate = stm32_fmc2_ebi_ns_to_clock_cycles,
785*4882a593Smuzhiyun 		.set = stm32_fmc2_ebi_set_bl_setup,
786*4882a593Smuzhiyun 	},
787*4882a593Smuzhiyun 	{
788*4882a593Smuzhiyun 		.name = "st,fmc2-ebi-cs-address-setup-ns",
789*4882a593Smuzhiyun 		.reg_type = FMC2_REG_BTR,
790*4882a593Smuzhiyun 		.reset_val = FMC2_BXTR_ADDSET_MAX,
791*4882a593Smuzhiyun 		.check = stm32_fmc2_ebi_check_async_trans,
792*4882a593Smuzhiyun 		.calculate = stm32_fmc2_ebi_ns_to_clock_cycles,
793*4882a593Smuzhiyun 		.set = stm32_fmc2_ebi_set_address_setup,
794*4882a593Smuzhiyun 	},
795*4882a593Smuzhiyun 	{
796*4882a593Smuzhiyun 		.name = "st,fmc2-ebi-cs-address-hold-ns",
797*4882a593Smuzhiyun 		.reg_type = FMC2_REG_BTR,
798*4882a593Smuzhiyun 		.reset_val = FMC2_BXTR_ADDHLD_MAX,
799*4882a593Smuzhiyun 		.check = stm32_fmc2_ebi_check_address_hold,
800*4882a593Smuzhiyun 		.calculate = stm32_fmc2_ebi_ns_to_clock_cycles,
801*4882a593Smuzhiyun 		.set = stm32_fmc2_ebi_set_address_hold,
802*4882a593Smuzhiyun 	},
803*4882a593Smuzhiyun 	{
804*4882a593Smuzhiyun 		.name = "st,fmc2-ebi-cs-data-setup-ns",
805*4882a593Smuzhiyun 		.reg_type = FMC2_REG_BTR,
806*4882a593Smuzhiyun 		.reset_val = FMC2_BXTR_DATAST_MAX,
807*4882a593Smuzhiyun 		.check = stm32_fmc2_ebi_check_async_trans,
808*4882a593Smuzhiyun 		.calculate = stm32_fmc2_ebi_ns_to_clock_cycles,
809*4882a593Smuzhiyun 		.set = stm32_fmc2_ebi_set_data_setup,
810*4882a593Smuzhiyun 	},
811*4882a593Smuzhiyun 	{
812*4882a593Smuzhiyun 		.name = "st,fmc2-ebi-cs-bus-turnaround-ns",
813*4882a593Smuzhiyun 		.reg_type = FMC2_REG_BTR,
814*4882a593Smuzhiyun 		.reset_val = FMC2_BXTR_BUSTURN_MAX + 1,
815*4882a593Smuzhiyun 		.calculate = stm32_fmc2_ebi_ns_to_clock_cycles,
816*4882a593Smuzhiyun 		.set = stm32_fmc2_ebi_set_bus_turnaround,
817*4882a593Smuzhiyun 	},
818*4882a593Smuzhiyun 	{
819*4882a593Smuzhiyun 		.name = "st,fmc2-ebi-cs-data-hold-ns",
820*4882a593Smuzhiyun 		.reg_type = FMC2_REG_BTR,
821*4882a593Smuzhiyun 		.check = stm32_fmc2_ebi_check_async_trans,
822*4882a593Smuzhiyun 		.calculate = stm32_fmc2_ebi_ns_to_clock_cycles,
823*4882a593Smuzhiyun 		.set = stm32_fmc2_ebi_set_data_hold,
824*4882a593Smuzhiyun 	},
825*4882a593Smuzhiyun 	{
826*4882a593Smuzhiyun 		.name = "st,fmc2-ebi-cs-clk-period-ns",
827*4882a593Smuzhiyun 		.reset_val = FMC2_BTR_CLKDIV_MAX + 1,
828*4882a593Smuzhiyun 		.check = stm32_fmc2_ebi_check_clk_period,
829*4882a593Smuzhiyun 		.calculate = stm32_fmc2_ebi_ns_to_clock_cycles,
830*4882a593Smuzhiyun 		.set = stm32_fmc2_ebi_set_clk_period,
831*4882a593Smuzhiyun 	},
832*4882a593Smuzhiyun 	{
833*4882a593Smuzhiyun 		.name = "st,fmc2-ebi-cs-data-latency-ns",
834*4882a593Smuzhiyun 		.check = stm32_fmc2_ebi_check_sync_trans,
835*4882a593Smuzhiyun 		.calculate = stm32_fmc2_ebi_ns_to_clk_period,
836*4882a593Smuzhiyun 		.set = stm32_fmc2_ebi_set_data_latency,
837*4882a593Smuzhiyun 	},
838*4882a593Smuzhiyun 	{
839*4882a593Smuzhiyun 		.name = "st,fmc2-ebi-cs-write-address-setup-ns",
840*4882a593Smuzhiyun 		.reg_type = FMC2_REG_BWTR,
841*4882a593Smuzhiyun 		.reset_val = FMC2_BXTR_ADDSET_MAX,
842*4882a593Smuzhiyun 		.check = stm32_fmc2_ebi_check_async_trans,
843*4882a593Smuzhiyun 		.calculate = stm32_fmc2_ebi_ns_to_clock_cycles,
844*4882a593Smuzhiyun 		.set = stm32_fmc2_ebi_set_address_setup,
845*4882a593Smuzhiyun 	},
846*4882a593Smuzhiyun 	{
847*4882a593Smuzhiyun 		.name = "st,fmc2-ebi-cs-write-address-hold-ns",
848*4882a593Smuzhiyun 		.reg_type = FMC2_REG_BWTR,
849*4882a593Smuzhiyun 		.reset_val = FMC2_BXTR_ADDHLD_MAX,
850*4882a593Smuzhiyun 		.check = stm32_fmc2_ebi_check_address_hold,
851*4882a593Smuzhiyun 		.calculate = stm32_fmc2_ebi_ns_to_clock_cycles,
852*4882a593Smuzhiyun 		.set = stm32_fmc2_ebi_set_address_hold,
853*4882a593Smuzhiyun 	},
854*4882a593Smuzhiyun 	{
855*4882a593Smuzhiyun 		.name = "st,fmc2-ebi-cs-write-data-setup-ns",
856*4882a593Smuzhiyun 		.reg_type = FMC2_REG_BWTR,
857*4882a593Smuzhiyun 		.reset_val = FMC2_BXTR_DATAST_MAX,
858*4882a593Smuzhiyun 		.check = stm32_fmc2_ebi_check_async_trans,
859*4882a593Smuzhiyun 		.calculate = stm32_fmc2_ebi_ns_to_clock_cycles,
860*4882a593Smuzhiyun 		.set = stm32_fmc2_ebi_set_data_setup,
861*4882a593Smuzhiyun 	},
862*4882a593Smuzhiyun 	{
863*4882a593Smuzhiyun 		.name = "st,fmc2-ebi-cs-write-bus-turnaround-ns",
864*4882a593Smuzhiyun 		.reg_type = FMC2_REG_BWTR,
865*4882a593Smuzhiyun 		.reset_val = FMC2_BXTR_BUSTURN_MAX + 1,
866*4882a593Smuzhiyun 		.calculate = stm32_fmc2_ebi_ns_to_clock_cycles,
867*4882a593Smuzhiyun 		.set = stm32_fmc2_ebi_set_bus_turnaround,
868*4882a593Smuzhiyun 	},
869*4882a593Smuzhiyun 	{
870*4882a593Smuzhiyun 		.name = "st,fmc2-ebi-cs-write-data-hold-ns",
871*4882a593Smuzhiyun 		.reg_type = FMC2_REG_BWTR,
872*4882a593Smuzhiyun 		.check = stm32_fmc2_ebi_check_async_trans,
873*4882a593Smuzhiyun 		.calculate = stm32_fmc2_ebi_ns_to_clock_cycles,
874*4882a593Smuzhiyun 		.set = stm32_fmc2_ebi_set_data_hold,
875*4882a593Smuzhiyun 	},
876*4882a593Smuzhiyun 	{
877*4882a593Smuzhiyun 		.name = "st,fmc2-ebi-cs-max-low-pulse-ns",
878*4882a593Smuzhiyun 		.calculate = stm32_fmc2_ebi_ns_to_clock_cycles,
879*4882a593Smuzhiyun 		.set = stm32_fmc2_ebi_set_max_low_pulse,
880*4882a593Smuzhiyun 	},
881*4882a593Smuzhiyun };
882*4882a593Smuzhiyun 
stm32_fmc2_ebi_parse_prop(struct stm32_fmc2_ebi * ebi,struct device_node * dev_node,const struct stm32_fmc2_prop * prop,int cs)883*4882a593Smuzhiyun static int stm32_fmc2_ebi_parse_prop(struct stm32_fmc2_ebi *ebi,
884*4882a593Smuzhiyun 				     struct device_node *dev_node,
885*4882a593Smuzhiyun 				     const struct stm32_fmc2_prop *prop,
886*4882a593Smuzhiyun 				     int cs)
887*4882a593Smuzhiyun {
888*4882a593Smuzhiyun 	struct device *dev = ebi->dev;
889*4882a593Smuzhiyun 	u32 setup = 0;
890*4882a593Smuzhiyun 
891*4882a593Smuzhiyun 	if (!prop->set) {
892*4882a593Smuzhiyun 		dev_err(dev, "property %s is not well defined\n", prop->name);
893*4882a593Smuzhiyun 		return -EINVAL;
894*4882a593Smuzhiyun 	}
895*4882a593Smuzhiyun 
896*4882a593Smuzhiyun 	if (prop->check && prop->check(ebi, prop, cs))
897*4882a593Smuzhiyun 		/* Skeep this property */
898*4882a593Smuzhiyun 		return 0;
899*4882a593Smuzhiyun 
900*4882a593Smuzhiyun 	if (prop->bprop) {
901*4882a593Smuzhiyun 		bool bprop;
902*4882a593Smuzhiyun 
903*4882a593Smuzhiyun 		bprop = of_property_read_bool(dev_node, prop->name);
904*4882a593Smuzhiyun 		if (prop->mprop && !bprop) {
905*4882a593Smuzhiyun 			dev_err(dev, "mandatory property %s not defined in the device tree\n",
906*4882a593Smuzhiyun 				prop->name);
907*4882a593Smuzhiyun 			return -EINVAL;
908*4882a593Smuzhiyun 		}
909*4882a593Smuzhiyun 
910*4882a593Smuzhiyun 		if (bprop)
911*4882a593Smuzhiyun 			setup = 1;
912*4882a593Smuzhiyun 	} else {
913*4882a593Smuzhiyun 		u32 val;
914*4882a593Smuzhiyun 		int ret;
915*4882a593Smuzhiyun 
916*4882a593Smuzhiyun 		ret = of_property_read_u32(dev_node, prop->name, &val);
917*4882a593Smuzhiyun 		if (prop->mprop && ret) {
918*4882a593Smuzhiyun 			dev_err(dev, "mandatory property %s not defined in the device tree\n",
919*4882a593Smuzhiyun 				prop->name);
920*4882a593Smuzhiyun 			return ret;
921*4882a593Smuzhiyun 		}
922*4882a593Smuzhiyun 
923*4882a593Smuzhiyun 		if (ret)
924*4882a593Smuzhiyun 			setup = prop->reset_val;
925*4882a593Smuzhiyun 		else if (prop->calculate)
926*4882a593Smuzhiyun 			setup = prop->calculate(ebi, cs, val);
927*4882a593Smuzhiyun 		else
928*4882a593Smuzhiyun 			setup = val;
929*4882a593Smuzhiyun 	}
930*4882a593Smuzhiyun 
931*4882a593Smuzhiyun 	return prop->set(ebi, prop, cs, setup);
932*4882a593Smuzhiyun }
933*4882a593Smuzhiyun 
stm32_fmc2_ebi_enable_bank(struct stm32_fmc2_ebi * ebi,int cs)934*4882a593Smuzhiyun static void stm32_fmc2_ebi_enable_bank(struct stm32_fmc2_ebi *ebi, int cs)
935*4882a593Smuzhiyun {
936*4882a593Smuzhiyun 	regmap_update_bits(ebi->regmap, FMC2_BCR(cs),
937*4882a593Smuzhiyun 			   FMC2_BCR_MBKEN, FMC2_BCR_MBKEN);
938*4882a593Smuzhiyun }
939*4882a593Smuzhiyun 
stm32_fmc2_ebi_disable_bank(struct stm32_fmc2_ebi * ebi,int cs)940*4882a593Smuzhiyun static void stm32_fmc2_ebi_disable_bank(struct stm32_fmc2_ebi *ebi, int cs)
941*4882a593Smuzhiyun {
942*4882a593Smuzhiyun 	regmap_update_bits(ebi->regmap, FMC2_BCR(cs), FMC2_BCR_MBKEN, 0);
943*4882a593Smuzhiyun }
944*4882a593Smuzhiyun 
stm32_fmc2_ebi_save_setup(struct stm32_fmc2_ebi * ebi)945*4882a593Smuzhiyun static void stm32_fmc2_ebi_save_setup(struct stm32_fmc2_ebi *ebi)
946*4882a593Smuzhiyun {
947*4882a593Smuzhiyun 	unsigned int cs;
948*4882a593Smuzhiyun 
949*4882a593Smuzhiyun 	for (cs = 0; cs < FMC2_MAX_EBI_CE; cs++) {
950*4882a593Smuzhiyun 		regmap_read(ebi->regmap, FMC2_BCR(cs), &ebi->bcr[cs]);
951*4882a593Smuzhiyun 		regmap_read(ebi->regmap, FMC2_BTR(cs), &ebi->btr[cs]);
952*4882a593Smuzhiyun 		regmap_read(ebi->regmap, FMC2_BWTR(cs), &ebi->bwtr[cs]);
953*4882a593Smuzhiyun 	}
954*4882a593Smuzhiyun 
955*4882a593Smuzhiyun 	regmap_read(ebi->regmap, FMC2_PCSCNTR, &ebi->pcscntr);
956*4882a593Smuzhiyun }
957*4882a593Smuzhiyun 
stm32_fmc2_ebi_set_setup(struct stm32_fmc2_ebi * ebi)958*4882a593Smuzhiyun static void stm32_fmc2_ebi_set_setup(struct stm32_fmc2_ebi *ebi)
959*4882a593Smuzhiyun {
960*4882a593Smuzhiyun 	unsigned int cs;
961*4882a593Smuzhiyun 
962*4882a593Smuzhiyun 	for (cs = 0; cs < FMC2_MAX_EBI_CE; cs++) {
963*4882a593Smuzhiyun 		regmap_write(ebi->regmap, FMC2_BCR(cs), ebi->bcr[cs]);
964*4882a593Smuzhiyun 		regmap_write(ebi->regmap, FMC2_BTR(cs), ebi->btr[cs]);
965*4882a593Smuzhiyun 		regmap_write(ebi->regmap, FMC2_BWTR(cs), ebi->bwtr[cs]);
966*4882a593Smuzhiyun 	}
967*4882a593Smuzhiyun 
968*4882a593Smuzhiyun 	regmap_write(ebi->regmap, FMC2_PCSCNTR, ebi->pcscntr);
969*4882a593Smuzhiyun }
970*4882a593Smuzhiyun 
stm32_fmc2_ebi_disable_banks(struct stm32_fmc2_ebi * ebi)971*4882a593Smuzhiyun static void stm32_fmc2_ebi_disable_banks(struct stm32_fmc2_ebi *ebi)
972*4882a593Smuzhiyun {
973*4882a593Smuzhiyun 	unsigned int cs;
974*4882a593Smuzhiyun 
975*4882a593Smuzhiyun 	for (cs = 0; cs < FMC2_MAX_EBI_CE; cs++) {
976*4882a593Smuzhiyun 		if (!(ebi->bank_assigned & BIT(cs)))
977*4882a593Smuzhiyun 			continue;
978*4882a593Smuzhiyun 
979*4882a593Smuzhiyun 		stm32_fmc2_ebi_disable_bank(ebi, cs);
980*4882a593Smuzhiyun 	}
981*4882a593Smuzhiyun }
982*4882a593Smuzhiyun 
983*4882a593Smuzhiyun /* NWAIT signal can not be connected to EBI controller and NAND controller */
stm32_fmc2_ebi_nwait_used_by_ctrls(struct stm32_fmc2_ebi * ebi)984*4882a593Smuzhiyun static bool stm32_fmc2_ebi_nwait_used_by_ctrls(struct stm32_fmc2_ebi *ebi)
985*4882a593Smuzhiyun {
986*4882a593Smuzhiyun 	unsigned int cs;
987*4882a593Smuzhiyun 	u32 bcr;
988*4882a593Smuzhiyun 
989*4882a593Smuzhiyun 	for (cs = 0; cs < FMC2_MAX_EBI_CE; cs++) {
990*4882a593Smuzhiyun 		if (!(ebi->bank_assigned & BIT(cs)))
991*4882a593Smuzhiyun 			continue;
992*4882a593Smuzhiyun 
993*4882a593Smuzhiyun 		regmap_read(ebi->regmap, FMC2_BCR(cs), &bcr);
994*4882a593Smuzhiyun 		if ((bcr & FMC2_BCR_WAITEN || bcr & FMC2_BCR_ASYNCWAIT) &&
995*4882a593Smuzhiyun 		    ebi->bank_assigned & BIT(FMC2_NAND))
996*4882a593Smuzhiyun 			return true;
997*4882a593Smuzhiyun 	}
998*4882a593Smuzhiyun 
999*4882a593Smuzhiyun 	return false;
1000*4882a593Smuzhiyun }
1001*4882a593Smuzhiyun 
stm32_fmc2_ebi_enable(struct stm32_fmc2_ebi * ebi)1002*4882a593Smuzhiyun static void stm32_fmc2_ebi_enable(struct stm32_fmc2_ebi *ebi)
1003*4882a593Smuzhiyun {
1004*4882a593Smuzhiyun 	regmap_update_bits(ebi->regmap, FMC2_BCR1,
1005*4882a593Smuzhiyun 			   FMC2_BCR1_FMC2EN, FMC2_BCR1_FMC2EN);
1006*4882a593Smuzhiyun }
1007*4882a593Smuzhiyun 
stm32_fmc2_ebi_disable(struct stm32_fmc2_ebi * ebi)1008*4882a593Smuzhiyun static void stm32_fmc2_ebi_disable(struct stm32_fmc2_ebi *ebi)
1009*4882a593Smuzhiyun {
1010*4882a593Smuzhiyun 	regmap_update_bits(ebi->regmap, FMC2_BCR1, FMC2_BCR1_FMC2EN, 0);
1011*4882a593Smuzhiyun }
1012*4882a593Smuzhiyun 
stm32_fmc2_ebi_setup_cs(struct stm32_fmc2_ebi * ebi,struct device_node * dev_node,u32 cs)1013*4882a593Smuzhiyun static int stm32_fmc2_ebi_setup_cs(struct stm32_fmc2_ebi *ebi,
1014*4882a593Smuzhiyun 				   struct device_node *dev_node,
1015*4882a593Smuzhiyun 				   u32 cs)
1016*4882a593Smuzhiyun {
1017*4882a593Smuzhiyun 	unsigned int i;
1018*4882a593Smuzhiyun 	int ret;
1019*4882a593Smuzhiyun 
1020*4882a593Smuzhiyun 	stm32_fmc2_ebi_disable_bank(ebi, cs);
1021*4882a593Smuzhiyun 
1022*4882a593Smuzhiyun 	for (i = 0; i < ARRAY_SIZE(stm32_fmc2_child_props); i++) {
1023*4882a593Smuzhiyun 		const struct stm32_fmc2_prop *p = &stm32_fmc2_child_props[i];
1024*4882a593Smuzhiyun 
1025*4882a593Smuzhiyun 		ret = stm32_fmc2_ebi_parse_prop(ebi, dev_node, p, cs);
1026*4882a593Smuzhiyun 		if (ret) {
1027*4882a593Smuzhiyun 			dev_err(ebi->dev, "property %s could not be set: %d\n",
1028*4882a593Smuzhiyun 				p->name, ret);
1029*4882a593Smuzhiyun 			return ret;
1030*4882a593Smuzhiyun 		}
1031*4882a593Smuzhiyun 	}
1032*4882a593Smuzhiyun 
1033*4882a593Smuzhiyun 	stm32_fmc2_ebi_enable_bank(ebi, cs);
1034*4882a593Smuzhiyun 
1035*4882a593Smuzhiyun 	return 0;
1036*4882a593Smuzhiyun }
1037*4882a593Smuzhiyun 
stm32_fmc2_ebi_parse_dt(struct stm32_fmc2_ebi * ebi)1038*4882a593Smuzhiyun static int stm32_fmc2_ebi_parse_dt(struct stm32_fmc2_ebi *ebi)
1039*4882a593Smuzhiyun {
1040*4882a593Smuzhiyun 	struct device *dev = ebi->dev;
1041*4882a593Smuzhiyun 	struct device_node *child;
1042*4882a593Smuzhiyun 	bool child_found = false;
1043*4882a593Smuzhiyun 	u32 bank;
1044*4882a593Smuzhiyun 	int ret;
1045*4882a593Smuzhiyun 
1046*4882a593Smuzhiyun 	for_each_available_child_of_node(dev->of_node, child) {
1047*4882a593Smuzhiyun 		ret = of_property_read_u32(child, "reg", &bank);
1048*4882a593Smuzhiyun 		if (ret) {
1049*4882a593Smuzhiyun 			dev_err(dev, "could not retrieve reg property: %d\n",
1050*4882a593Smuzhiyun 				ret);
1051*4882a593Smuzhiyun 			of_node_put(child);
1052*4882a593Smuzhiyun 			return ret;
1053*4882a593Smuzhiyun 		}
1054*4882a593Smuzhiyun 
1055*4882a593Smuzhiyun 		if (bank >= FMC2_MAX_BANKS) {
1056*4882a593Smuzhiyun 			dev_err(dev, "invalid reg value: %d\n", bank);
1057*4882a593Smuzhiyun 			of_node_put(child);
1058*4882a593Smuzhiyun 			return -EINVAL;
1059*4882a593Smuzhiyun 		}
1060*4882a593Smuzhiyun 
1061*4882a593Smuzhiyun 		if (ebi->bank_assigned & BIT(bank)) {
1062*4882a593Smuzhiyun 			dev_err(dev, "bank already assigned: %d\n", bank);
1063*4882a593Smuzhiyun 			of_node_put(child);
1064*4882a593Smuzhiyun 			return -EINVAL;
1065*4882a593Smuzhiyun 		}
1066*4882a593Smuzhiyun 
1067*4882a593Smuzhiyun 		if (bank < FMC2_MAX_EBI_CE) {
1068*4882a593Smuzhiyun 			ret = stm32_fmc2_ebi_setup_cs(ebi, child, bank);
1069*4882a593Smuzhiyun 			if (ret) {
1070*4882a593Smuzhiyun 				dev_err(dev, "setup chip select %d failed: %d\n",
1071*4882a593Smuzhiyun 					bank, ret);
1072*4882a593Smuzhiyun 				of_node_put(child);
1073*4882a593Smuzhiyun 				return ret;
1074*4882a593Smuzhiyun 			}
1075*4882a593Smuzhiyun 		}
1076*4882a593Smuzhiyun 
1077*4882a593Smuzhiyun 		ebi->bank_assigned |= BIT(bank);
1078*4882a593Smuzhiyun 		child_found = true;
1079*4882a593Smuzhiyun 	}
1080*4882a593Smuzhiyun 
1081*4882a593Smuzhiyun 	if (!child_found) {
1082*4882a593Smuzhiyun 		dev_warn(dev, "no subnodes found, disable the driver.\n");
1083*4882a593Smuzhiyun 		return -ENODEV;
1084*4882a593Smuzhiyun 	}
1085*4882a593Smuzhiyun 
1086*4882a593Smuzhiyun 	if (stm32_fmc2_ebi_nwait_used_by_ctrls(ebi)) {
1087*4882a593Smuzhiyun 		dev_err(dev, "NWAIT signal connected to EBI and NAND controllers\n");
1088*4882a593Smuzhiyun 		return -EINVAL;
1089*4882a593Smuzhiyun 	}
1090*4882a593Smuzhiyun 
1091*4882a593Smuzhiyun 	stm32_fmc2_ebi_enable(ebi);
1092*4882a593Smuzhiyun 
1093*4882a593Smuzhiyun 	return of_platform_populate(dev->of_node, NULL, NULL, dev);
1094*4882a593Smuzhiyun }
1095*4882a593Smuzhiyun 
stm32_fmc2_ebi_probe(struct platform_device * pdev)1096*4882a593Smuzhiyun static int stm32_fmc2_ebi_probe(struct platform_device *pdev)
1097*4882a593Smuzhiyun {
1098*4882a593Smuzhiyun 	struct device *dev = &pdev->dev;
1099*4882a593Smuzhiyun 	struct stm32_fmc2_ebi *ebi;
1100*4882a593Smuzhiyun 	struct reset_control *rstc;
1101*4882a593Smuzhiyun 	int ret;
1102*4882a593Smuzhiyun 
1103*4882a593Smuzhiyun 	ebi = devm_kzalloc(&pdev->dev, sizeof(*ebi), GFP_KERNEL);
1104*4882a593Smuzhiyun 	if (!ebi)
1105*4882a593Smuzhiyun 		return -ENOMEM;
1106*4882a593Smuzhiyun 
1107*4882a593Smuzhiyun 	ebi->dev = dev;
1108*4882a593Smuzhiyun 
1109*4882a593Smuzhiyun 	ebi->regmap = device_node_to_regmap(dev->of_node);
1110*4882a593Smuzhiyun 	if (IS_ERR(ebi->regmap))
1111*4882a593Smuzhiyun 		return PTR_ERR(ebi->regmap);
1112*4882a593Smuzhiyun 
1113*4882a593Smuzhiyun 	ebi->clk = devm_clk_get(dev, NULL);
1114*4882a593Smuzhiyun 	if (IS_ERR(ebi->clk))
1115*4882a593Smuzhiyun 		return PTR_ERR(ebi->clk);
1116*4882a593Smuzhiyun 
1117*4882a593Smuzhiyun 	rstc = devm_reset_control_get(dev, NULL);
1118*4882a593Smuzhiyun 	if (PTR_ERR(rstc) == -EPROBE_DEFER)
1119*4882a593Smuzhiyun 		return -EPROBE_DEFER;
1120*4882a593Smuzhiyun 
1121*4882a593Smuzhiyun 	ret = clk_prepare_enable(ebi->clk);
1122*4882a593Smuzhiyun 	if (ret)
1123*4882a593Smuzhiyun 		return ret;
1124*4882a593Smuzhiyun 
1125*4882a593Smuzhiyun 	if (!IS_ERR(rstc)) {
1126*4882a593Smuzhiyun 		reset_control_assert(rstc);
1127*4882a593Smuzhiyun 		reset_control_deassert(rstc);
1128*4882a593Smuzhiyun 	}
1129*4882a593Smuzhiyun 
1130*4882a593Smuzhiyun 	ret = stm32_fmc2_ebi_parse_dt(ebi);
1131*4882a593Smuzhiyun 	if (ret)
1132*4882a593Smuzhiyun 		goto err_release;
1133*4882a593Smuzhiyun 
1134*4882a593Smuzhiyun 	stm32_fmc2_ebi_save_setup(ebi);
1135*4882a593Smuzhiyun 	platform_set_drvdata(pdev, ebi);
1136*4882a593Smuzhiyun 
1137*4882a593Smuzhiyun 	return 0;
1138*4882a593Smuzhiyun 
1139*4882a593Smuzhiyun err_release:
1140*4882a593Smuzhiyun 	stm32_fmc2_ebi_disable_banks(ebi);
1141*4882a593Smuzhiyun 	stm32_fmc2_ebi_disable(ebi);
1142*4882a593Smuzhiyun 	clk_disable_unprepare(ebi->clk);
1143*4882a593Smuzhiyun 
1144*4882a593Smuzhiyun 	return ret;
1145*4882a593Smuzhiyun }
1146*4882a593Smuzhiyun 
stm32_fmc2_ebi_remove(struct platform_device * pdev)1147*4882a593Smuzhiyun static int stm32_fmc2_ebi_remove(struct platform_device *pdev)
1148*4882a593Smuzhiyun {
1149*4882a593Smuzhiyun 	struct stm32_fmc2_ebi *ebi = platform_get_drvdata(pdev);
1150*4882a593Smuzhiyun 
1151*4882a593Smuzhiyun 	of_platform_depopulate(&pdev->dev);
1152*4882a593Smuzhiyun 	stm32_fmc2_ebi_disable_banks(ebi);
1153*4882a593Smuzhiyun 	stm32_fmc2_ebi_disable(ebi);
1154*4882a593Smuzhiyun 	clk_disable_unprepare(ebi->clk);
1155*4882a593Smuzhiyun 
1156*4882a593Smuzhiyun 	return 0;
1157*4882a593Smuzhiyun }
1158*4882a593Smuzhiyun 
stm32_fmc2_ebi_suspend(struct device * dev)1159*4882a593Smuzhiyun static int __maybe_unused stm32_fmc2_ebi_suspend(struct device *dev)
1160*4882a593Smuzhiyun {
1161*4882a593Smuzhiyun 	struct stm32_fmc2_ebi *ebi = dev_get_drvdata(dev);
1162*4882a593Smuzhiyun 
1163*4882a593Smuzhiyun 	stm32_fmc2_ebi_disable(ebi);
1164*4882a593Smuzhiyun 	clk_disable_unprepare(ebi->clk);
1165*4882a593Smuzhiyun 	pinctrl_pm_select_sleep_state(dev);
1166*4882a593Smuzhiyun 
1167*4882a593Smuzhiyun 	return 0;
1168*4882a593Smuzhiyun }
1169*4882a593Smuzhiyun 
stm32_fmc2_ebi_resume(struct device * dev)1170*4882a593Smuzhiyun static int __maybe_unused stm32_fmc2_ebi_resume(struct device *dev)
1171*4882a593Smuzhiyun {
1172*4882a593Smuzhiyun 	struct stm32_fmc2_ebi *ebi = dev_get_drvdata(dev);
1173*4882a593Smuzhiyun 	int ret;
1174*4882a593Smuzhiyun 
1175*4882a593Smuzhiyun 	pinctrl_pm_select_default_state(dev);
1176*4882a593Smuzhiyun 
1177*4882a593Smuzhiyun 	ret = clk_prepare_enable(ebi->clk);
1178*4882a593Smuzhiyun 	if (ret)
1179*4882a593Smuzhiyun 		return ret;
1180*4882a593Smuzhiyun 
1181*4882a593Smuzhiyun 	stm32_fmc2_ebi_set_setup(ebi);
1182*4882a593Smuzhiyun 	stm32_fmc2_ebi_enable(ebi);
1183*4882a593Smuzhiyun 
1184*4882a593Smuzhiyun 	return 0;
1185*4882a593Smuzhiyun }
1186*4882a593Smuzhiyun 
1187*4882a593Smuzhiyun static SIMPLE_DEV_PM_OPS(stm32_fmc2_ebi_pm_ops, stm32_fmc2_ebi_suspend,
1188*4882a593Smuzhiyun 			 stm32_fmc2_ebi_resume);
1189*4882a593Smuzhiyun 
1190*4882a593Smuzhiyun static const struct of_device_id stm32_fmc2_ebi_match[] = {
1191*4882a593Smuzhiyun 	{.compatible = "st,stm32mp1-fmc2-ebi"},
1192*4882a593Smuzhiyun 	{}
1193*4882a593Smuzhiyun };
1194*4882a593Smuzhiyun MODULE_DEVICE_TABLE(of, stm32_fmc2_ebi_match);
1195*4882a593Smuzhiyun 
1196*4882a593Smuzhiyun static struct platform_driver stm32_fmc2_ebi_driver = {
1197*4882a593Smuzhiyun 	.probe	= stm32_fmc2_ebi_probe,
1198*4882a593Smuzhiyun 	.remove	= stm32_fmc2_ebi_remove,
1199*4882a593Smuzhiyun 	.driver	= {
1200*4882a593Smuzhiyun 		.name = "stm32_fmc2_ebi",
1201*4882a593Smuzhiyun 		.of_match_table = stm32_fmc2_ebi_match,
1202*4882a593Smuzhiyun 		.pm = &stm32_fmc2_ebi_pm_ops,
1203*4882a593Smuzhiyun 	},
1204*4882a593Smuzhiyun };
1205*4882a593Smuzhiyun module_platform_driver(stm32_fmc2_ebi_driver);
1206*4882a593Smuzhiyun 
1207*4882a593Smuzhiyun MODULE_ALIAS("platform:stm32_fmc2_ebi");
1208*4882a593Smuzhiyun MODULE_AUTHOR("Christophe Kerello <christophe.kerello@st.com>");
1209*4882a593Smuzhiyun MODULE_DESCRIPTION("STMicroelectronics STM32 FMC2 ebi driver");
1210*4882a593Smuzhiyun MODULE_LICENSE("GPL v2");
1211