1
2
3
4
5
6
7#include <common.h>
8#include <clk.h>
9#include <dm.h>
10#include <ram.h>
11#include <asm/io.h>
12
13#define MEM_MODE_MASK GENMASK(2, 0)
14#define NOT_FOUND 0xff
15
16struct stm32_fmc_regs {
17
18 u32 bcr1;
19 u32 btr1;
20 u32 bcr2;
21 u32 btr2;
22 u32 bcr3;
23 u32 btr3;
24 u32 bcr4;
25 u32 btr4;
26 u32 reserved1[24];
27
28
29 u32 pcr;
30 u32 sr;
31 u32 pmem;
32 u32 patt;
33 u32 reserved2[1];
34 u32 eccr;
35 u32 reserved3[27];
36
37
38 u32 bwtr1;
39 u32 reserved4[1];
40 u32 bwtr2;
41 u32 reserved5[1];
42 u32 bwtr3;
43 u32 reserved6[1];
44 u32 bwtr4;
45 u32 reserved7[8];
46
47
48 u32 sdcr1;
49 u32 sdcr2;
50 u32 sdtr1;
51 u32 sdtr2;
52 u32 sdcmr;
53 u32 sdrtr;
54 u32 sdsr;
55};
56
57
58
59
60
61#define FMC_BCR1_FMCEN BIT(31)
62
63
64#define FMC_SDCR_RPIPE_SHIFT 13
65#define FMC_SDCR_RBURST_SHIFT 12
66#define FMC_SDCR_SDCLK_SHIFT 10
67#define FMC_SDCR_WP_SHIFT 9
68#define FMC_SDCR_CAS_SHIFT 7
69#define FMC_SDCR_NB_SHIFT 6
70#define FMC_SDCR_MWID_SHIFT 4
71#define FMC_SDCR_NR_SHIFT 2
72#define FMC_SDCR_NC_SHIFT 0
73
74
75#define FMC_SDTR_TMRD_SHIFT 0
76#define FMC_SDTR_TXSR_SHIFT 4
77#define FMC_SDTR_TRAS_SHIFT 8
78#define FMC_SDTR_TRC_SHIFT 12
79#define FMC_SDTR_TWR_SHIFT 16
80#define FMC_SDTR_TRP_SHIFT 20
81#define FMC_SDTR_TRCD_SHIFT 24
82
83#define FMC_SDCMR_NRFS_SHIFT 5
84
85#define FMC_SDCMR_MODE_NORMAL 0
86#define FMC_SDCMR_MODE_START_CLOCK 1
87#define FMC_SDCMR_MODE_PRECHARGE 2
88#define FMC_SDCMR_MODE_AUTOREFRESH 3
89#define FMC_SDCMR_MODE_WRITE_MODE 4
90#define FMC_SDCMR_MODE_SELFREFRESH 5
91#define FMC_SDCMR_MODE_POWERDOWN 6
92
93#define FMC_SDCMR_BANK_1 BIT(4)
94#define FMC_SDCMR_BANK_2 BIT(3)
95
96#define FMC_SDCMR_MODE_REGISTER_SHIFT 9
97
98#define FMC_SDSR_BUSY BIT(5)
99
100#define FMC_BUSY_WAIT(regs) do { \
101 __asm__ __volatile__ ("dsb" : : : "memory"); \
102 while (regs->sdsr & FMC_SDSR_BUSY) \
103 ; \
104 } while (0)
105
106struct stm32_sdram_control {
107 u8 no_columns;
108 u8 no_rows;
109 u8 memory_width;
110 u8 no_banks;
111 u8 cas_latency;
112 u8 sdclk;
113 u8 rd_burst;
114 u8 rd_pipe_delay;
115};
116
117struct stm32_sdram_timing {
118 u8 tmrd;
119 u8 txsr;
120 u8 tras;
121 u8 trc;
122 u8 trp;
123 u8 twr;
124 u8 trcd;
125};
126enum stm32_fmc_bank {
127 SDRAM_BANK1,
128 SDRAM_BANK2,
129 MAX_SDRAM_BANK,
130};
131
132enum stm32_fmc_family {
133 STM32F7_FMC,
134 STM32H7_FMC,
135};
136
137struct bank_params {
138 struct stm32_sdram_control *sdram_control;
139 struct stm32_sdram_timing *sdram_timing;
140 u32 sdram_ref_count;
141 enum stm32_fmc_bank target_bank;
142};
143
144struct stm32_sdram_params {
145 struct stm32_fmc_regs *base;
146 u8 no_sdram_banks;
147 struct bank_params bank_params[MAX_SDRAM_BANK];
148 enum stm32_fmc_family family;
149};
150
151#define SDRAM_MODE_BL_SHIFT 0
152#define SDRAM_MODE_CAS_SHIFT 4
153#define SDRAM_MODE_BL 0
154
155int stm32_sdram_init(struct udevice *dev)
156{
157 struct stm32_sdram_params *params = dev_get_platdata(dev);
158 struct stm32_sdram_control *control;
159 struct stm32_sdram_timing *timing;
160 struct stm32_fmc_regs *regs = params->base;
161 enum stm32_fmc_bank target_bank;
162 u32 ctb;
163 u32 ref_count;
164 u8 i;
165
166
167 if (params->family == STM32H7_FMC)
168 clrbits_le32(®s->bcr1, FMC_BCR1_FMCEN);
169
170 for (i = 0; i < params->no_sdram_banks; i++) {
171 control = params->bank_params[i].sdram_control;
172 timing = params->bank_params[i].sdram_timing;
173 target_bank = params->bank_params[i].target_bank;
174 ref_count = params->bank_params[i].sdram_ref_count;
175
176 writel(control->sdclk << FMC_SDCR_SDCLK_SHIFT
177 | control->cas_latency << FMC_SDCR_CAS_SHIFT
178 | control->no_banks << FMC_SDCR_NB_SHIFT
179 | control->memory_width << FMC_SDCR_MWID_SHIFT
180 | control->no_rows << FMC_SDCR_NR_SHIFT
181 | control->no_columns << FMC_SDCR_NC_SHIFT
182 | control->rd_pipe_delay << FMC_SDCR_RPIPE_SHIFT
183 | control->rd_burst << FMC_SDCR_RBURST_SHIFT,
184 ®s->sdcr1);
185
186 if (target_bank == SDRAM_BANK2)
187 writel(control->cas_latency << FMC_SDCR_CAS_SHIFT
188 | control->no_banks << FMC_SDCR_NB_SHIFT
189 | control->memory_width << FMC_SDCR_MWID_SHIFT
190 | control->no_rows << FMC_SDCR_NR_SHIFT
191 | control->no_columns << FMC_SDCR_NC_SHIFT,
192 ®s->sdcr2);
193
194 writel(timing->trcd << FMC_SDTR_TRCD_SHIFT
195 | timing->trp << FMC_SDTR_TRP_SHIFT
196 | timing->twr << FMC_SDTR_TWR_SHIFT
197 | timing->trc << FMC_SDTR_TRC_SHIFT
198 | timing->tras << FMC_SDTR_TRAS_SHIFT
199 | timing->txsr << FMC_SDTR_TXSR_SHIFT
200 | timing->tmrd << FMC_SDTR_TMRD_SHIFT,
201 ®s->sdtr1);
202
203 if (target_bank == SDRAM_BANK2)
204 writel(timing->trcd << FMC_SDTR_TRCD_SHIFT
205 | timing->trp << FMC_SDTR_TRP_SHIFT
206 | timing->twr << FMC_SDTR_TWR_SHIFT
207 | timing->trc << FMC_SDTR_TRC_SHIFT
208 | timing->tras << FMC_SDTR_TRAS_SHIFT
209 | timing->txsr << FMC_SDTR_TXSR_SHIFT
210 | timing->tmrd << FMC_SDTR_TMRD_SHIFT,
211 ®s->sdtr2);
212
213 if (target_bank == SDRAM_BANK1)
214 ctb = FMC_SDCMR_BANK_1;
215 else
216 ctb = FMC_SDCMR_BANK_2;
217
218 writel(ctb | FMC_SDCMR_MODE_START_CLOCK, ®s->sdcmr);
219 udelay(200);
220 FMC_BUSY_WAIT(regs);
221
222 writel(ctb | FMC_SDCMR_MODE_PRECHARGE, ®s->sdcmr);
223 udelay(100);
224 FMC_BUSY_WAIT(regs);
225
226 writel((ctb | FMC_SDCMR_MODE_AUTOREFRESH | 7 << FMC_SDCMR_NRFS_SHIFT),
227 ®s->sdcmr);
228 udelay(100);
229 FMC_BUSY_WAIT(regs);
230
231 writel(ctb | (SDRAM_MODE_BL << SDRAM_MODE_BL_SHIFT
232 | control->cas_latency << SDRAM_MODE_CAS_SHIFT)
233 << FMC_SDCMR_MODE_REGISTER_SHIFT | FMC_SDCMR_MODE_WRITE_MODE,
234 ®s->sdcmr);
235 udelay(100);
236 FMC_BUSY_WAIT(regs);
237
238 writel(ctb | FMC_SDCMR_MODE_NORMAL, ®s->sdcmr);
239 FMC_BUSY_WAIT(regs);
240
241
242 writel(ref_count << 1, ®s->sdrtr);
243 }
244
245
246 if (params->family == STM32H7_FMC)
247 setbits_le32(®s->bcr1, FMC_BCR1_FMCEN);
248
249 return 0;
250}
251
252static int stm32_fmc_ofdata_to_platdata(struct udevice *dev)
253{
254 struct stm32_sdram_params *params = dev_get_platdata(dev);
255 struct bank_params *bank_params;
256 struct ofnode_phandle_args args;
257 u32 *syscfg_base;
258 u32 mem_remap;
259 ofnode bank_node;
260 char *bank_name;
261 u8 bank = 0;
262 int ret;
263
264 mem_remap = dev_read_u32_default(dev, "st,mem_remap", NOT_FOUND);
265 if (mem_remap != NOT_FOUND) {
266 ret = dev_read_phandle_with_args(dev, "st,syscfg", NULL, 0, 0,
267 &args);
268 if (ret) {
269 debug("%s: can't find syscon device (%d)\n", __func__,
270 ret);
271 return ret;
272 }
273
274 syscfg_base = (u32 *)ofnode_get_addr(args.node);
275
276
277 clrsetbits_le32(syscfg_base, MEM_MODE_MASK, mem_remap);
278 } else {
279 debug("%s: cannot find st,mem_remap property\n", __func__);
280 }
281
282 dev_for_each_subnode(bank_node, dev) {
283
284 bank_name = (char *)ofnode_get_name(bank_node);
285 strsep(&bank_name, "@");
286 if (!bank_name) {
287 pr_err("missing sdram bank index");
288 return -EINVAL;
289 }
290
291 bank_params = ¶ms->bank_params[bank];
292 strict_strtoul(bank_name, 10,
293 (long unsigned int *)&bank_params->target_bank);
294
295 if (bank_params->target_bank >= MAX_SDRAM_BANK) {
296 pr_err("Found bank %d , but only bank 0 and 1 are supported",
297 bank_params->target_bank);
298 return -EINVAL;
299 }
300
301 debug("Find bank %s %u\n", bank_name, bank_params->target_bank);
302
303 params->bank_params[bank].sdram_control =
304 (struct stm32_sdram_control *)
305 ofnode_read_u8_array_ptr(bank_node,
306 "st,sdram-control",
307 sizeof(struct stm32_sdram_control));
308
309 if (!params->bank_params[bank].sdram_control) {
310 pr_err("st,sdram-control not found for %s",
311 ofnode_get_name(bank_node));
312 return -EINVAL;
313 }
314
315
316 params->bank_params[bank].sdram_timing =
317 (struct stm32_sdram_timing *)
318 ofnode_read_u8_array_ptr(bank_node,
319 "st,sdram-timing",
320 sizeof(struct stm32_sdram_timing));
321
322 if (!params->bank_params[bank].sdram_timing) {
323 pr_err("st,sdram-timing not found for %s",
324 ofnode_get_name(bank_node));
325 return -EINVAL;
326 }
327
328
329 bank_params->sdram_ref_count = ofnode_read_u32_default(bank_node,
330 "st,sdram-refcount", 8196);
331 bank++;
332 }
333
334 params->no_sdram_banks = bank;
335 debug("%s, no of banks = %d\n", __func__, params->no_sdram_banks);
336
337 return 0;
338}
339
340static int stm32_fmc_probe(struct udevice *dev)
341{
342 struct stm32_sdram_params *params = dev_get_platdata(dev);
343 int ret;
344 fdt_addr_t addr;
345
346 addr = dev_read_addr(dev);
347 if (addr == FDT_ADDR_T_NONE)
348 return -EINVAL;
349
350 params->base = (struct stm32_fmc_regs *)addr;
351 params->family = dev_get_driver_data(dev);
352
353#ifdef CONFIG_CLK
354 struct clk clk;
355
356 ret = clk_get_by_index(dev, 0, &clk);
357 if (ret < 0)
358 return ret;
359
360 ret = clk_enable(&clk);
361
362 if (ret) {
363 dev_err(dev, "failed to enable clock\n");
364 return ret;
365 }
366#endif
367 ret = stm32_sdram_init(dev);
368 if (ret)
369 return ret;
370
371 return 0;
372}
373
374static int stm32_fmc_get_info(struct udevice *dev, struct ram_info *info)
375{
376 return 0;
377}
378
379static struct ram_ops stm32_fmc_ops = {
380 .get_info = stm32_fmc_get_info,
381};
382
383static const struct udevice_id stm32_fmc_ids[] = {
384 { .compatible = "st,stm32-fmc", .data = STM32F7_FMC },
385 { .compatible = "st,stm32h7-fmc", .data = STM32H7_FMC },
386 { }
387};
388
389U_BOOT_DRIVER(stm32_fmc) = {
390 .name = "stm32_fmc",
391 .id = UCLASS_RAM,
392 .of_match = stm32_fmc_ids,
393 .ops = &stm32_fmc_ops,
394 .ofdata_to_platdata = stm32_fmc_ofdata_to_platdata,
395 .probe = stm32_fmc_probe,
396 .platdata_auto_alloc_size = sizeof(struct stm32_sdram_params),
397};
398