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