source: src/linux/universal/linux-4.9/drivers/memory/atmel-ebi.c @ 31662

Last change on this file since 31662 was 31662, checked in by brainslayer, 5 months ago

use new squashfs in all kernels

File size: 19.5 KB
Line 
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->name)
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);
Note: See TracBrowser for help on using the repository browser.