blob: f87ad6f5d2dcce8e6620cbfe9bc5c55469e4ffde [file] [log] [blame]
Boris Brezillon6a4ec4c2016-05-23 09:44:54 +02001/*
2 * EBI driver for Atmel chips
3 * inspired by the fsl weim bus driver
4 *
5 * Copyright (C) 2013 Jean-Jacques Hiblot <jjhiblot@traphandler.com>
6 *
7 * This file is licensed under the terms of the GNU General Public
8 * License version 2. This program is licensed "as is" without any
9 * warranty of any kind, whether express or implied.
10 */
11
12#include <linux/clk.h>
13#include <linux/io.h>
14#include <linux/mfd/syscon.h>
15#include <linux/mfd/syscon/atmel-matrix.h>
16#include <linux/mfd/syscon/atmel-smc.h>
Paul Gortmaker8a86a092016-06-16 20:37:48 -040017#include <linux/init.h>
Boris Brezillon6a4ec4c2016-05-23 09:44:54 +020018#include <linux/of_device.h>
19#include <linux/regmap.h>
20
21struct at91sam9_smc_timings {
22 u32 ncs_rd_setup_ns;
23 u32 nrd_setup_ns;
24 u32 ncs_wr_setup_ns;
25 u32 nwe_setup_ns;
26 u32 ncs_rd_pulse_ns;
27 u32 nrd_pulse_ns;
28 u32 ncs_wr_pulse_ns;
29 u32 nwe_pulse_ns;
30 u32 nrd_cycle_ns;
31 u32 nwe_cycle_ns;
32 u32 tdf_ns;
33};
34
35struct at91sam9_smc_generic_fields {
36 struct regmap_field *setup;
37 struct regmap_field *pulse;
38 struct regmap_field *cycle;
39 struct regmap_field *mode;
40};
41
42struct at91sam9_ebi_dev_config {
43 struct at91sam9_smc_timings timings;
44 u32 mode;
45};
46
47struct at91_ebi_dev_config {
48 int cs;
49 union {
50 struct at91sam9_ebi_dev_config sam9;
51 };
52};
53
54struct at91_ebi;
55
56struct at91_ebi_dev {
57 struct list_head node;
58 struct at91_ebi *ebi;
59 u32 mode;
60 int numcs;
61 struct at91_ebi_dev_config configs[];
62};
63
64struct at91_ebi_caps {
65 unsigned int available_cs;
66 const struct reg_field *ebi_csa;
67 void (*get_config)(struct at91_ebi_dev *ebid,
68 struct at91_ebi_dev_config *conf);
69 int (*xlate_config)(struct at91_ebi_dev *ebid,
70 struct device_node *configs_np,
71 struct at91_ebi_dev_config *conf);
72 int (*apply_config)(struct at91_ebi_dev *ebid,
73 struct at91_ebi_dev_config *conf);
74 int (*init)(struct at91_ebi *ebi);
75};
76
77struct at91_ebi {
78 struct clk *clk;
79 struct regmap *smc;
80 struct regmap *matrix;
81
82 struct regmap_field *ebi_csa;
83
84 struct device *dev;
85 const struct at91_ebi_caps *caps;
86 struct list_head devs;
87 union {
88 struct at91sam9_smc_generic_fields sam9;
89 };
90};
91
92static void at91sam9_ebi_get_config(struct at91_ebi_dev *ebid,
93 struct at91_ebi_dev_config *conf)
94{
95 struct at91sam9_smc_generic_fields *fields = &ebid->ebi->sam9;
96 unsigned int clk_rate = clk_get_rate(ebid->ebi->clk);
97 struct at91sam9_ebi_dev_config *config = &conf->sam9;
98 struct at91sam9_smc_timings *timings = &config->timings;
99 unsigned int val;
100
101 regmap_fields_read(fields->mode, conf->cs, &val);
102 config->mode = val & ~AT91_SMC_TDF;
103
104 val = (val & AT91_SMC_TDF) >> 16;
105 timings->tdf_ns = clk_rate * val;
106
107 regmap_fields_read(fields->setup, conf->cs, &val);
108 timings->ncs_rd_setup_ns = (val >> 24) & 0x1f;
109 timings->ncs_rd_setup_ns += ((val >> 29) & 0x1) * 128;
110 timings->ncs_rd_setup_ns *= clk_rate;
111 timings->nrd_setup_ns = (val >> 16) & 0x1f;
112 timings->nrd_setup_ns += ((val >> 21) & 0x1) * 128;
113 timings->nrd_setup_ns *= clk_rate;
114 timings->ncs_wr_setup_ns = (val >> 8) & 0x1f;
115 timings->ncs_wr_setup_ns += ((val >> 13) & 0x1) * 128;
116 timings->ncs_wr_setup_ns *= clk_rate;
117 timings->nwe_setup_ns = val & 0x1f;
118 timings->nwe_setup_ns += ((val >> 5) & 0x1) * 128;
119 timings->nwe_setup_ns *= clk_rate;
120
121 regmap_fields_read(fields->pulse, conf->cs, &val);
122 timings->ncs_rd_pulse_ns = (val >> 24) & 0x3f;
123 timings->ncs_rd_pulse_ns += ((val >> 30) & 0x1) * 256;
124 timings->ncs_rd_pulse_ns *= clk_rate;
125 timings->nrd_pulse_ns = (val >> 16) & 0x3f;
126 timings->nrd_pulse_ns += ((val >> 22) & 0x1) * 256;
127 timings->nrd_pulse_ns *= clk_rate;
128 timings->ncs_wr_pulse_ns = (val >> 8) & 0x3f;
129 timings->ncs_wr_pulse_ns += ((val >> 14) & 0x1) * 256;
130 timings->ncs_wr_pulse_ns *= clk_rate;
131 timings->nwe_pulse_ns = val & 0x3f;
132 timings->nwe_pulse_ns += ((val >> 6) & 0x1) * 256;
133 timings->nwe_pulse_ns *= clk_rate;
134
135 regmap_fields_read(fields->cycle, conf->cs, &val);
136 timings->nrd_cycle_ns = (val >> 16) & 0x7f;
137 timings->nrd_cycle_ns += ((val >> 23) & 0x3) * 256;
138 timings->nrd_cycle_ns *= clk_rate;
139 timings->nwe_cycle_ns = val & 0x7f;
140 timings->nwe_cycle_ns += ((val >> 7) & 0x3) * 256;
141 timings->nwe_cycle_ns *= clk_rate;
142}
143
144static int at91_xlate_timing(struct device_node *np, const char *prop,
145 u32 *val, bool *required)
146{
147 if (!of_property_read_u32(np, prop, val)) {
148 *required = true;
149 return 0;
150 }
151
152 if (*required)
153 return -EINVAL;
154
155 return 0;
156}
157
158static int at91sam9_smc_xslate_timings(struct at91_ebi_dev *ebid,
159 struct device_node *np,
160 struct at91sam9_smc_timings *timings,
161 bool *required)
162{
163 int ret;
164
165 ret = at91_xlate_timing(np, "atmel,smc-ncs-rd-setup-ns",
166 &timings->ncs_rd_setup_ns, required);
167 if (ret)
168 goto out;
169
170 ret = at91_xlate_timing(np, "atmel,smc-nrd-setup-ns",
171 &timings->nrd_setup_ns, required);
172 if (ret)
173 goto out;
174
175 ret = at91_xlate_timing(np, "atmel,smc-ncs-wr-setup-ns",
176 &timings->ncs_wr_setup_ns, required);
177 if (ret)
178 goto out;
179
180 ret = at91_xlate_timing(np, "atmel,smc-nwe-setup-ns",
181 &timings->nwe_setup_ns, required);
182 if (ret)
183 goto out;
184
185 ret = at91_xlate_timing(np, "atmel,smc-ncs-rd-pulse-ns",
186 &timings->ncs_rd_pulse_ns, required);
187 if (ret)
188 goto out;
189
190 ret = at91_xlate_timing(np, "atmel,smc-nrd-pulse-ns",
191 &timings->nrd_pulse_ns, required);
192 if (ret)
193 goto out;
194
195 ret = at91_xlate_timing(np, "atmel,smc-ncs-wr-pulse-ns",
196 &timings->ncs_wr_pulse_ns, required);
197 if (ret)
198 goto out;
199
200 ret = at91_xlate_timing(np, "atmel,smc-nwe-pulse-ns",
201 &timings->nwe_pulse_ns, required);
202 if (ret)
203 goto out;
204
205 ret = at91_xlate_timing(np, "atmel,smc-nwe-cycle-ns",
206 &timings->nwe_cycle_ns, required);
207 if (ret)
208 goto out;
209
210 ret = at91_xlate_timing(np, "atmel,smc-nrd-cycle-ns",
211 &timings->nrd_cycle_ns, required);
212 if (ret)
213 goto out;
214
215 ret = at91_xlate_timing(np, "atmel,smc-tdf-ns",
216 &timings->tdf_ns, required);
217
218out:
219 if (ret)
220 dev_err(ebid->ebi->dev,
221 "missing or invalid timings definition in %s",
222 np->full_name);
223
224 return ret;
225}
226
227static int at91sam9_ebi_xslate_config(struct at91_ebi_dev *ebid,
228 struct device_node *np,
229 struct at91_ebi_dev_config *conf)
230{
231 struct at91sam9_ebi_dev_config *config = &conf->sam9;
232 bool required = false;
233 const char *tmp_str;
234 u32 tmp;
235 int ret;
236
237 ret = of_property_read_u32(np, "atmel,smc-bus-width", &tmp);
238 if (!ret) {
239 switch (tmp) {
240 case 8:
241 config->mode |= AT91_SMC_DBW_8;
242 break;
243
244 case 16:
245 config->mode |= AT91_SMC_DBW_16;
246 break;
247
248 case 32:
249 config->mode |= AT91_SMC_DBW_32;
250 break;
251
252 default:
253 return -EINVAL;
254 }
255
256 required = true;
257 }
258
259 if (of_property_read_bool(np, "atmel,smc-tdf-optimized")) {
260 config->mode |= AT91_SMC_TDFMODE_OPTIMIZED;
261 required = true;
262 }
263
264 tmp_str = NULL;
265 of_property_read_string(np, "atmel,smc-byte-access-type", &tmp_str);
266 if (tmp_str && !strcmp(tmp_str, "write")) {
267 config->mode |= AT91_SMC_BAT_WRITE;
268 required = true;
269 }
270
271 tmp_str = NULL;
272 of_property_read_string(np, "atmel,smc-read-mode", &tmp_str);
273 if (tmp_str && !strcmp(tmp_str, "nrd")) {
274 config->mode |= AT91_SMC_READMODE_NRD;
275 required = true;
276 }
277
278 tmp_str = NULL;
279 of_property_read_string(np, "atmel,smc-write-mode", &tmp_str);
280 if (tmp_str && !strcmp(tmp_str, "nwe")) {
281 config->mode |= AT91_SMC_WRITEMODE_NWE;
282 required = true;
283 }
284
285 tmp_str = NULL;
286 of_property_read_string(np, "atmel,smc-exnw-mode", &tmp_str);
287 if (tmp_str) {
288 if (!strcmp(tmp_str, "frozen"))
289 config->mode |= AT91_SMC_EXNWMODE_FROZEN;
290 else if (!strcmp(tmp_str, "ready"))
291 config->mode |= AT91_SMC_EXNWMODE_READY;
292 else if (strcmp(tmp_str, "disabled"))
293 return -EINVAL;
294
295 required = true;
296 }
297
298 ret = of_property_read_u32(np, "atmel,smc-page-mode", &tmp);
299 if (!ret) {
300 switch (tmp) {
301 case 4:
302 config->mode |= AT91_SMC_PS_4;
303 break;
304
305 case 8:
306 config->mode |= AT91_SMC_PS_8;
307 break;
308
309 case 16:
310 config->mode |= AT91_SMC_PS_16;
311 break;
312
313 case 32:
314 config->mode |= AT91_SMC_PS_32;
315 break;
316
317 default:
318 return -EINVAL;
319 }
320
321 config->mode |= AT91_SMC_PMEN;
322 required = true;
323 }
324
325 ret = at91sam9_smc_xslate_timings(ebid, np, &config->timings,
326 &required);
327 if (ret)
328 return ret;
329
330 return required;
331}
332
333static int at91sam9_ebi_apply_config(struct at91_ebi_dev *ebid,
334 struct at91_ebi_dev_config *conf)
335{
336 unsigned int clk_rate = clk_get_rate(ebid->ebi->clk);
337 struct at91sam9_ebi_dev_config *config = &conf->sam9;
338 struct at91sam9_smc_timings *timings = &config->timings;
339 struct at91sam9_smc_generic_fields *fields = &ebid->ebi->sam9;
340 u32 coded_val;
341 u32 val;
342
343 coded_val = at91sam9_smc_setup_ns_to_cycles(clk_rate,
344 timings->ncs_rd_setup_ns);
345 val = AT91SAM9_SMC_NCS_NRDSETUP(coded_val);
346 coded_val = at91sam9_smc_setup_ns_to_cycles(clk_rate,
347 timings->nrd_setup_ns);
348 val |= AT91SAM9_SMC_NRDSETUP(coded_val);
349 coded_val = at91sam9_smc_setup_ns_to_cycles(clk_rate,
350 timings->ncs_wr_setup_ns);
351 val |= AT91SAM9_SMC_NCS_WRSETUP(coded_val);
352 coded_val = at91sam9_smc_setup_ns_to_cycles(clk_rate,
353 timings->nwe_setup_ns);
354 val |= AT91SAM9_SMC_NWESETUP(coded_val);
355 regmap_fields_write(fields->setup, conf->cs, val);
356
357 coded_val = at91sam9_smc_pulse_ns_to_cycles(clk_rate,
358 timings->ncs_rd_pulse_ns);
359 val = AT91SAM9_SMC_NCS_NRDPULSE(coded_val);
360 coded_val = at91sam9_smc_pulse_ns_to_cycles(clk_rate,
361 timings->nrd_pulse_ns);
362 val |= AT91SAM9_SMC_NRDPULSE(coded_val);
363 coded_val = at91sam9_smc_pulse_ns_to_cycles(clk_rate,
364 timings->ncs_wr_pulse_ns);
365 val |= AT91SAM9_SMC_NCS_WRPULSE(coded_val);
366 coded_val = at91sam9_smc_pulse_ns_to_cycles(clk_rate,
367 timings->nwe_pulse_ns);
368 val |= AT91SAM9_SMC_NWEPULSE(coded_val);
369 regmap_fields_write(fields->pulse, conf->cs, val);
370
371 coded_val = at91sam9_smc_cycle_ns_to_cycles(clk_rate,
372 timings->nrd_cycle_ns);
373 val = AT91SAM9_SMC_NRDCYCLE(coded_val);
374 coded_val = at91sam9_smc_cycle_ns_to_cycles(clk_rate,
375 timings->nwe_cycle_ns);
376 val |= AT91SAM9_SMC_NWECYCLE(coded_val);
377 regmap_fields_write(fields->cycle, conf->cs, val);
378
379 val = DIV_ROUND_UP(timings->tdf_ns, clk_rate);
380 if (val > AT91_SMC_TDF_MAX)
381 val = AT91_SMC_TDF_MAX;
382 regmap_fields_write(fields->mode, conf->cs,
383 config->mode | AT91_SMC_TDF_(val));
384
385 return 0;
386}
387
388static int at91sam9_ebi_init(struct at91_ebi *ebi)
389{
390 struct at91sam9_smc_generic_fields *fields = &ebi->sam9;
391 struct reg_field field = REG_FIELD(0, 0, 31);
392
393 field.id_size = fls(ebi->caps->available_cs);
394 field.id_offset = AT91SAM9_SMC_GENERIC_BLK_SZ;
395
396 field.reg = AT91SAM9_SMC_SETUP(AT91SAM9_SMC_GENERIC);
397 fields->setup = devm_regmap_field_alloc(ebi->dev, ebi->smc, field);
398 if (IS_ERR(fields->setup))
399 return PTR_ERR(fields->setup);
400
401 field.reg = AT91SAM9_SMC_PULSE(AT91SAM9_SMC_GENERIC);
402 fields->pulse = devm_regmap_field_alloc(ebi->dev, ebi->smc, field);
403 if (IS_ERR(fields->pulse))
404 return PTR_ERR(fields->pulse);
405
406 field.reg = AT91SAM9_SMC_CYCLE(AT91SAM9_SMC_GENERIC);
407 fields->cycle = devm_regmap_field_alloc(ebi->dev, ebi->smc, field);
408 if (IS_ERR(fields->cycle))
409 return PTR_ERR(fields->cycle);
410
411 field.reg = AT91SAM9_SMC_MODE(AT91SAM9_SMC_GENERIC);
412 fields->mode = devm_regmap_field_alloc(ebi->dev, ebi->smc, field);
413 if (IS_ERR(fields->mode))
414 return PTR_ERR(fields->mode);
415
416 return 0;
417}
418
419static int sama5d3_ebi_init(struct at91_ebi *ebi)
420{
421 struct at91sam9_smc_generic_fields *fields = &ebi->sam9;
422 struct reg_field field = REG_FIELD(0, 0, 31);
423
424 field.id_size = fls(ebi->caps->available_cs);
425 field.id_offset = SAMA5_SMC_GENERIC_BLK_SZ;
426
427 field.reg = AT91SAM9_SMC_SETUP(SAMA5_SMC_GENERIC);
428 fields->setup = devm_regmap_field_alloc(ebi->dev, ebi->smc, field);
429 if (IS_ERR(fields->setup))
430 return PTR_ERR(fields->setup);
431
432 field.reg = AT91SAM9_SMC_PULSE(SAMA5_SMC_GENERIC);
433 fields->pulse = devm_regmap_field_alloc(ebi->dev, ebi->smc, field);
434 if (IS_ERR(fields->pulse))
435 return PTR_ERR(fields->pulse);
436
437 field.reg = AT91SAM9_SMC_CYCLE(SAMA5_SMC_GENERIC);
438 fields->cycle = devm_regmap_field_alloc(ebi->dev, ebi->smc, field);
439 if (IS_ERR(fields->cycle))
440 return PTR_ERR(fields->cycle);
441
442 field.reg = SAMA5_SMC_MODE(SAMA5_SMC_GENERIC);
443 fields->mode = devm_regmap_field_alloc(ebi->dev, ebi->smc, field);
444 if (IS_ERR(fields->mode))
445 return PTR_ERR(fields->mode);
446
447 return 0;
448}
449
450static int at91_ebi_dev_setup(struct at91_ebi *ebi, struct device_node *np,
451 int reg_cells)
452{
453 const struct at91_ebi_caps *caps = ebi->caps;
454 struct at91_ebi_dev_config conf = { };
455 struct device *dev = ebi->dev;
456 struct at91_ebi_dev *ebid;
457 int ret, numcs = 0, i;
458 bool apply = false;
459
460 numcs = of_property_count_elems_of_size(np, "reg",
461 reg_cells * sizeof(u32));
462 if (numcs <= 0) {
463 dev_err(dev, "invalid reg property in %s\n", np->full_name);
464 return -EINVAL;
465 }
466
467 ebid = devm_kzalloc(ebi->dev,
468 sizeof(*ebid) + (numcs * sizeof(*ebid->configs)),
469 GFP_KERNEL);
470 if (!ebid)
471 return -ENOMEM;
472
473 ebid->ebi = ebi;
474
475 ret = caps->xlate_config(ebid, np, &conf);
476 if (ret < 0)
477 return ret;
478 else if (ret)
479 apply = true;
480
481 for (i = 0; i < numcs; i++) {
482 u32 cs;
483
484 ret = of_property_read_u32_index(np, "reg", i * reg_cells,
485 &cs);
486 if (ret)
487 return ret;
488
489 if (cs > AT91_MATRIX_EBI_NUM_CS ||
490 !(ebi->caps->available_cs & BIT(cs))) {
491 dev_err(dev, "invalid reg property in %s\n",
492 np->full_name);
493 return -EINVAL;
494 }
495
496 ebid->configs[i].cs = cs;
497
498 if (apply) {
499 conf.cs = cs;
500 ret = caps->apply_config(ebid, &conf);
501 if (ret)
502 return ret;
503 }
504
505 caps->get_config(ebid, &ebid->configs[i]);
506
507 /*
508 * Attach the EBI device to the generic SMC logic if at least
509 * one "atmel,smc-" property is present.
510 */
511 if (ebi->ebi_csa && ret)
512 regmap_field_update_bits(ebi->ebi_csa,
513 BIT(cs), 0);
514 }
515
516 list_add_tail(&ebid->node, &ebi->devs);
517
518 return 0;
519}
520
521static const struct reg_field at91sam9260_ebi_csa =
522 REG_FIELD(AT91SAM9260_MATRIX_EBICSA, 0,
523 AT91_MATRIX_EBI_NUM_CS - 1);
524
525static const struct at91_ebi_caps at91sam9260_ebi_caps = {
526 .available_cs = 0xff,
527 .ebi_csa = &at91sam9260_ebi_csa,
528 .get_config = at91sam9_ebi_get_config,
529 .xlate_config = at91sam9_ebi_xslate_config,
530 .apply_config = at91sam9_ebi_apply_config,
531 .init = at91sam9_ebi_init,
532};
533
534static const struct reg_field at91sam9261_ebi_csa =
535 REG_FIELD(AT91SAM9261_MATRIX_EBICSA, 0,
536 AT91_MATRIX_EBI_NUM_CS - 1);
537
538static const struct at91_ebi_caps at91sam9261_ebi_caps = {
539 .available_cs = 0xff,
540 .ebi_csa = &at91sam9261_ebi_csa,
541 .get_config = at91sam9_ebi_get_config,
542 .xlate_config = at91sam9_ebi_xslate_config,
543 .apply_config = at91sam9_ebi_apply_config,
544 .init = at91sam9_ebi_init,
545};
546
547static const struct reg_field at91sam9263_ebi0_csa =
548 REG_FIELD(AT91SAM9263_MATRIX_EBI0CSA, 0,
549 AT91_MATRIX_EBI_NUM_CS - 1);
550
551static const struct at91_ebi_caps at91sam9263_ebi0_caps = {
552 .available_cs = 0x3f,
553 .ebi_csa = &at91sam9263_ebi0_csa,
554 .get_config = at91sam9_ebi_get_config,
555 .xlate_config = at91sam9_ebi_xslate_config,
556 .apply_config = at91sam9_ebi_apply_config,
557 .init = at91sam9_ebi_init,
558};
559
560static const struct reg_field at91sam9263_ebi1_csa =
561 REG_FIELD(AT91SAM9263_MATRIX_EBI1CSA, 0,
562 AT91_MATRIX_EBI_NUM_CS - 1);
563
564static const struct at91_ebi_caps at91sam9263_ebi1_caps = {
565 .available_cs = 0x7,
566 .ebi_csa = &at91sam9263_ebi1_csa,
567 .get_config = at91sam9_ebi_get_config,
568 .xlate_config = at91sam9_ebi_xslate_config,
569 .apply_config = at91sam9_ebi_apply_config,
570 .init = at91sam9_ebi_init,
571};
572
573static const struct reg_field at91sam9rl_ebi_csa =
574 REG_FIELD(AT91SAM9RL_MATRIX_EBICSA, 0,
575 AT91_MATRIX_EBI_NUM_CS - 1);
576
577static const struct at91_ebi_caps at91sam9rl_ebi_caps = {
578 .available_cs = 0x3f,
579 .ebi_csa = &at91sam9rl_ebi_csa,
580 .get_config = at91sam9_ebi_get_config,
581 .xlate_config = at91sam9_ebi_xslate_config,
582 .apply_config = at91sam9_ebi_apply_config,
583 .init = at91sam9_ebi_init,
584};
585
586static const struct reg_field at91sam9g45_ebi_csa =
587 REG_FIELD(AT91SAM9G45_MATRIX_EBICSA, 0,
588 AT91_MATRIX_EBI_NUM_CS - 1);
589
590static const struct at91_ebi_caps at91sam9g45_ebi_caps = {
591 .available_cs = 0x3f,
592 .ebi_csa = &at91sam9g45_ebi_csa,
593 .get_config = at91sam9_ebi_get_config,
594 .xlate_config = at91sam9_ebi_xslate_config,
595 .apply_config = at91sam9_ebi_apply_config,
596 .init = at91sam9_ebi_init,
597};
598
599static const struct at91_ebi_caps at91sam9x5_ebi_caps = {
600 .available_cs = 0x3f,
601 .ebi_csa = &at91sam9263_ebi0_csa,
602 .get_config = at91sam9_ebi_get_config,
603 .xlate_config = at91sam9_ebi_xslate_config,
604 .apply_config = at91sam9_ebi_apply_config,
605 .init = at91sam9_ebi_init,
606};
607
608static const struct at91_ebi_caps sama5d3_ebi_caps = {
609 .available_cs = 0xf,
610 .get_config = at91sam9_ebi_get_config,
611 .xlate_config = at91sam9_ebi_xslate_config,
612 .apply_config = at91sam9_ebi_apply_config,
613 .init = sama5d3_ebi_init,
614};
615
616static const struct of_device_id at91_ebi_id_table[] = {
617 {
618 .compatible = "atmel,at91sam9260-ebi",
619 .data = &at91sam9260_ebi_caps,
620 },
621 {
622 .compatible = "atmel,at91sam9261-ebi",
623 .data = &at91sam9261_ebi_caps,
624 },
625 {
626 .compatible = "atmel,at91sam9263-ebi0",
627 .data = &at91sam9263_ebi0_caps,
628 },
629 {
630 .compatible = "atmel,at91sam9263-ebi1",
631 .data = &at91sam9263_ebi1_caps,
632 },
633 {
634 .compatible = "atmel,at91sam9rl-ebi",
635 .data = &at91sam9rl_ebi_caps,
636 },
637 {
638 .compatible = "atmel,at91sam9g45-ebi",
639 .data = &at91sam9g45_ebi_caps,
640 },
641 {
642 .compatible = "atmel,at91sam9x5-ebi",
643 .data = &at91sam9x5_ebi_caps,
644 },
645 {
646 .compatible = "atmel,sama5d3-ebi",
647 .data = &sama5d3_ebi_caps,
648 },
649 { /* sentinel */ }
650};
Boris Brezillon6a4ec4c2016-05-23 09:44:54 +0200651
652static int at91_ebi_dev_disable(struct at91_ebi *ebi, struct device_node *np)
653{
654 struct device *dev = ebi->dev;
655 struct property *newprop;
656
657 newprop = devm_kzalloc(dev, sizeof(*newprop), GFP_KERNEL);
658 if (!newprop)
659 return -ENOMEM;
660
661 newprop->name = devm_kstrdup(dev, "status", GFP_KERNEL);
662 if (!newprop->name)
663 return -ENOMEM;
664
665 newprop->value = devm_kstrdup(dev, "disabled", GFP_KERNEL);
666 if (!newprop->name)
667 return -ENOMEM;
668
669 newprop->length = sizeof("disabled");
670
671 return of_update_property(np, newprop);
672}
673
674static int at91_ebi_probe(struct platform_device *pdev)
675{
676 struct device *dev = &pdev->dev;
677 struct device_node *child, *np = dev->of_node;
678 const struct of_device_id *match;
679 struct at91_ebi *ebi;
680 int ret, reg_cells;
681 struct clk *clk;
682 u32 val;
683
684 match = of_match_device(at91_ebi_id_table, dev);
685 if (!match || !match->data)
686 return -EINVAL;
687
688 ebi = devm_kzalloc(dev, sizeof(*ebi), GFP_KERNEL);
689 if (!ebi)
690 return -ENOMEM;
691
692 INIT_LIST_HEAD(&ebi->devs);
693 ebi->caps = match->data;
694 ebi->dev = dev;
695
696 clk = devm_clk_get(dev, NULL);
697 if (IS_ERR(clk))
698 return PTR_ERR(clk);
699
700 ebi->clk = clk;
701
702 ebi->smc = syscon_regmap_lookup_by_phandle(np, "atmel,smc");
703 if (IS_ERR(ebi->smc))
704 return PTR_ERR(ebi->smc);
705
706 /*
707 * The sama5d3 does not provide an EBICSA register and thus does need
708 * to access the matrix registers.
709 */
710 if (ebi->caps->ebi_csa) {
711 ebi->matrix =
712 syscon_regmap_lookup_by_phandle(np, "atmel,matrix");
713 if (IS_ERR(ebi->matrix))
714 return PTR_ERR(ebi->matrix);
715
716 ebi->ebi_csa = regmap_field_alloc(ebi->matrix,
717 *ebi->caps->ebi_csa);
718 if (IS_ERR(ebi->ebi_csa))
719 return PTR_ERR(ebi->ebi_csa);
720 }
721
722 ret = ebi->caps->init(ebi);
723 if (ret)
724 return ret;
725
726 ret = of_property_read_u32(np, "#address-cells", &val);
727 if (ret) {
728 dev_err(dev, "missing #address-cells property\n");
729 return ret;
730 }
731
732 reg_cells = val;
733
734 ret = of_property_read_u32(np, "#size-cells", &val);
735 if (ret) {
736 dev_err(dev, "missing #address-cells property\n");
737 return ret;
738 }
739
740 reg_cells += val;
741
742 for_each_available_child_of_node(np, child) {
743 if (!of_find_property(child, "reg", NULL))
744 continue;
745
746 ret = at91_ebi_dev_setup(ebi, child, reg_cells);
747 if (ret) {
748 dev_err(dev, "failed to configure EBI bus for %s, disabling the device",
749 child->full_name);
750
751 ret = at91_ebi_dev_disable(ebi, child);
752 if (ret)
753 return ret;
754 }
755 }
756
757 return of_platform_populate(np, NULL, NULL, dev);
758}
759
760static struct platform_driver at91_ebi_driver = {
761 .driver = {
762 .name = "atmel-ebi",
763 .of_match_table = at91_ebi_id_table,
764 },
765};
Paul Gortmaker8a86a092016-06-16 20:37:48 -0400766builtin_platform_driver_probe(at91_ebi_driver, at91_ebi_probe);