drivers/memory/atmel-ebi.c

   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
  21 struct 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
  35 struct 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
  42 struct at91sam9_ebi_dev_config {
  43         struct at91sam9_smc_timings timings;
  44         u32 mode;
  45 };
  46
  47 struct at91_ebi_dev_config {
  48         int cs;
  49         union {
  50                 struct at91sam9_ebi_dev_config sam9;
  51         };
  52 };
  53
  54 struct at91_ebi;
  55
  56 struct 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
  64 struct 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
  77 struct 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
  92 static 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
 144 static 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
 158 static 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
 218 out:
 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
 227 static 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
 333 static 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
 388 static 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         return PTR_ERR_OR_ZERO(fields->mode);
 414 }
 415
 416 static int sama5d3_ebi_init(struct at91_ebi *ebi)
 417 {
 418         struct at91sam9_smc_generic_fields *fields = &ebi->sam9;
 419         struct reg_field field = REG_FIELD(0, 0, 31);
 420
 421         field.id_size = fls(ebi->caps->available_cs);
 422         field.id_offset = SAMA5_SMC_GENERIC_BLK_SZ;
 423
 424         field.reg = AT91SAM9_SMC_SETUP(SAMA5_SMC_GENERIC);
 425         fields->setup = devm_regmap_field_alloc(ebi->dev, ebi->smc, field);
 426         if (IS_ERR(fields->setup))
 427                 return PTR_ERR(fields->setup);
 428
 429         field.reg = AT91SAM9_SMC_PULSE(SAMA5_SMC_GENERIC);
 430         fields->pulse = devm_regmap_field_alloc(ebi->dev, ebi->smc, field);
 431         if (IS_ERR(fields->pulse))
 432                 return PTR_ERR(fields->pulse);
 433
 434         field.reg = AT91SAM9_SMC_CYCLE(SAMA5_SMC_GENERIC);
 435         fields->cycle = devm_regmap_field_alloc(ebi->dev, ebi->smc, field);
 436         if (IS_ERR(fields->cycle))
 437                 return PTR_ERR(fields->cycle);
 438
 439         field.reg = SAMA5_SMC_MODE(SAMA5_SMC_GENERIC);
 440         fields->mode = devm_regmap_field_alloc(ebi->dev, ebi->smc, field);
 441         return PTR_ERR_OR_ZERO(fields->mode);
 442 }
 443
 444 static int at91_ebi_dev_setup(struct at91_ebi *ebi, struct device_node *np,
 445                               int reg_cells)
 446 {
 447         const struct at91_ebi_caps *caps = ebi->caps;
 448         struct at91_ebi_dev_config conf = { };
 449         struct device *dev = ebi->dev;
 450         struct at91_ebi_dev *ebid;
 451         int ret, numcs = 0, i;
 452         bool apply = false;
 453
 454         numcs = of_property_count_elems_of_size(np, "reg",
 455                                                 reg_cells * sizeof(u32));
 456         if (numcs <= 0) {
 457                 dev_err(dev, "invalid reg property in %s\n", np->full_name);
 458                 return -EINVAL;
 459         }
 460
 461         ebid = devm_kzalloc(ebi->dev,
 462                             sizeof(*ebid) + (numcs * sizeof(*ebid->configs)),
 463                             GFP_KERNEL);
 464         if (!ebid)
 465                 return -ENOMEM;
 466
 467         ebid->ebi = ebi;
 468
 469         ret = caps->xlate_config(ebid, np, &conf);
 470         if (ret < 0)
 471                 return ret;
 472         else if (ret)
 473                 apply = true;
 474
 475         for (i = 0; i < numcs; i++) {
 476                 u32 cs;
 477
 478                 ret = of_property_read_u32_index(np, "reg", i * reg_cells,
 479                                                  &cs);
 480                 if (ret)
 481                         return ret;
 482
 483                 if (cs > AT91_MATRIX_EBI_NUM_CS ||
 484                     !(ebi->caps->available_cs & BIT(cs))) {
 485                         dev_err(dev, "invalid reg property in %s\n",
 486                                 np->full_name);
 487                         return -EINVAL;
 488                 }
 489
 490                 ebid->configs[i].cs = cs;
 491
 492                 if (apply) {
 493                         conf.cs = cs;
 494                         ret = caps->apply_config(ebid, &conf);
 495                         if (ret)
 496                                 return ret;
 497                 }
 498
 499                 caps->get_config(ebid, &ebid->configs[i]);
 500
 501                 /*
 502                  * Attach the EBI device to the generic SMC logic if at least
 503                  * one "atmel,smc-" property is present.
 504                  */
 505                 if (ebi->ebi_csa && ret)
 506                         regmap_field_update_bits(ebi->ebi_csa,
 507                                                  BIT(cs), 0);
 508         }
 509
 510         list_add_tail(&ebid->node, &ebi->devs);
 511
 512         return 0;
 513 }
 514
 515 static const struct reg_field at91sam9260_ebi_csa =
 516                                 REG_FIELD(AT91SAM9260_MATRIX_EBICSA, 0,
 517                                           AT91_MATRIX_EBI_NUM_CS - 1);
 518
 519 static const struct at91_ebi_caps at91sam9260_ebi_caps = {
 520         .available_cs = 0xff,
 521         .ebi_csa = &at91sam9260_ebi_csa,
 522         .get_config = at91sam9_ebi_get_config,
 523         .xlate_config = at91sam9_ebi_xslate_config,
 524         .apply_config = at91sam9_ebi_apply_config,
 525         .init = at91sam9_ebi_init,
 526 };
 527
 528 static const struct reg_field at91sam9261_ebi_csa =
 529                                 REG_FIELD(AT91SAM9261_MATRIX_EBICSA, 0,
 530                                           AT91_MATRIX_EBI_NUM_CS - 1);
 531
 532 static const struct at91_ebi_caps at91sam9261_ebi_caps = {
 533         .available_cs = 0xff,
 534         .ebi_csa = &at91sam9261_ebi_csa,
 535         .get_config = at91sam9_ebi_get_config,
 536         .xlate_config = at91sam9_ebi_xslate_config,
 537         .apply_config = at91sam9_ebi_apply_config,
 538         .init = at91sam9_ebi_init,
 539 };
 540
 541 static const struct reg_field at91sam9263_ebi0_csa =
 542                                 REG_FIELD(AT91SAM9263_MATRIX_EBI0CSA, 0,
 543                                           AT91_MATRIX_EBI_NUM_CS - 1);
 544
 545 static const struct at91_ebi_caps at91sam9263_ebi0_caps = {
 546         .available_cs = 0x3f,
 547         .ebi_csa = &at91sam9263_ebi0_csa,
 548         .get_config = at91sam9_ebi_get_config,
 549         .xlate_config = at91sam9_ebi_xslate_config,
 550         .apply_config = at91sam9_ebi_apply_config,
 551         .init = at91sam9_ebi_init,
 552 };
 553
 554 static const struct reg_field at91sam9263_ebi1_csa =
 555                                 REG_FIELD(AT91SAM9263_MATRIX_EBI1CSA, 0,
 556                                           AT91_MATRIX_EBI_NUM_CS - 1);
 557
 558 static const struct at91_ebi_caps at91sam9263_ebi1_caps = {
 559         .available_cs = 0x7,
 560         .ebi_csa = &at91sam9263_ebi1_csa,
 561         .get_config = at91sam9_ebi_get_config,
 562         .xlate_config = at91sam9_ebi_xslate_config,
 563         .apply_config = at91sam9_ebi_apply_config,
 564         .init = at91sam9_ebi_init,
 565 };
 566
 567 static const struct reg_field at91sam9rl_ebi_csa =
 568                                 REG_FIELD(AT91SAM9RL_MATRIX_EBICSA, 0,
 569                                           AT91_MATRIX_EBI_NUM_CS - 1);
 570
 571 static const struct at91_ebi_caps at91sam9rl_ebi_caps = {
 572         .available_cs = 0x3f,
 573         .ebi_csa = &at91sam9rl_ebi_csa,
 574         .get_config = at91sam9_ebi_get_config,
 575         .xlate_config = at91sam9_ebi_xslate_config,
 576         .apply_config = at91sam9_ebi_apply_config,
 577         .init = at91sam9_ebi_init,
 578 };
 579
 580 static const struct reg_field at91sam9g45_ebi_csa =
 581                                 REG_FIELD(AT91SAM9G45_MATRIX_EBICSA, 0,
 582                                           AT91_MATRIX_EBI_NUM_CS - 1);
 583
 584 static const struct at91_ebi_caps at91sam9g45_ebi_caps = {
 585         .available_cs = 0x3f,
 586         .ebi_csa = &at91sam9g45_ebi_csa,
 587         .get_config = at91sam9_ebi_get_config,
 588         .xlate_config = at91sam9_ebi_xslate_config,
 589         .apply_config = at91sam9_ebi_apply_config,
 590         .init = at91sam9_ebi_init,
 591 };
 592
 593 static const struct at91_ebi_caps at91sam9x5_ebi_caps = {
 594         .available_cs = 0x3f,
 595         .ebi_csa = &at91sam9263_ebi0_csa,
 596         .get_config = at91sam9_ebi_get_config,
 597         .xlate_config = at91sam9_ebi_xslate_config,
 598         .apply_config = at91sam9_ebi_apply_config,
 599         .init = at91sam9_ebi_init,
 600 };
 601
 602 static const struct at91_ebi_caps sama5d3_ebi_caps = {
 603         .available_cs = 0xf,
 604         .get_config = at91sam9_ebi_get_config,
 605         .xlate_config = at91sam9_ebi_xslate_config,
 606         .apply_config = at91sam9_ebi_apply_config,
 607         .init = sama5d3_ebi_init,
 608 };
 609
 610 static const struct of_device_id at91_ebi_id_table[] = {
 611         {
 612                 .compatible = "atmel,at91sam9260-ebi",
 613                 .data = &at91sam9260_ebi_caps,
 614         },
 615         {
 616                 .compatible = "atmel,at91sam9261-ebi",
 617                 .data = &at91sam9261_ebi_caps,
 618         },
 619         {
 620                 .compatible = "atmel,at91sam9263-ebi0",
 621                 .data = &at91sam9263_ebi0_caps,
 622         },
 623         {
 624                 .compatible = "atmel,at91sam9263-ebi1",
 625                 .data = &at91sam9263_ebi1_caps,
 626         },
 627         {
 628                 .compatible = "atmel,at91sam9rl-ebi",
 629                 .data = &at91sam9rl_ebi_caps,
 630         },
 631         {
 632                 .compatible = "atmel,at91sam9g45-ebi",
 633                 .data = &at91sam9g45_ebi_caps,
 634         },
 635         {
 636                 .compatible = "atmel,at91sam9x5-ebi",
 637                 .data = &at91sam9x5_ebi_caps,
 638         },
 639         {
 640                 .compatible = "atmel,sama5d3-ebi",
 641                 .data = &sama5d3_ebi_caps,
 642         },
 643         { /* sentinel */ }
 644 };
 645
 646 static int at91_ebi_dev_disable(struct at91_ebi *ebi, struct device_node *np)
 647 {
 648         struct device *dev = ebi->dev;
 649         struct property *newprop;
 650
 651         newprop = devm_kzalloc(dev, sizeof(*newprop), GFP_KERNEL);
 652         if (!newprop)
 653                 return -ENOMEM;
 654
 655         newprop->name = devm_kstrdup(dev, "status", GFP_KERNEL);
 656         if (!newprop->name)
 657                 return -ENOMEM;
 658
 659         newprop->value = devm_kstrdup(dev, "disabled", GFP_KERNEL);
 660         if (!newprop->value)
 661                 return -ENOMEM;
 662
 663         newprop->length = sizeof("disabled");
 664
 665         return of_update_property(np, newprop);
 666 }
 667
 668 static int at91_ebi_probe(struct platform_device *pdev)
 669 {
 670         struct device *dev = &pdev->dev;
 671         struct device_node *child, *np = dev->of_node;
 672         const struct of_device_id *match;
 673         struct at91_ebi *ebi;
 674         int ret, reg_cells;
 675         struct clk *clk;
 676         u32 val;
 677
 678         match = of_match_device(at91_ebi_id_table, dev);
 679         if (!match || !match->data)
 680                 return -EINVAL;
 681
 682         ebi = devm_kzalloc(dev, sizeof(*ebi), GFP_KERNEL);
 683         if (!ebi)
 684                 return -ENOMEM;
 685
 686         INIT_LIST_HEAD(&ebi->devs);
 687         ebi->caps = match->data;
 688         ebi->dev = dev;
 689
 690         clk = devm_clk_get(dev, NULL);
 691         if (IS_ERR(clk))
 692                 return PTR_ERR(clk);
 693
 694         ebi->clk = clk;
 695
 696         ebi->smc = syscon_regmap_lookup_by_phandle(np, "atmel,smc");
 697         if (IS_ERR(ebi->smc))
 698                 return PTR_ERR(ebi->smc);
 699
 700         /*
 701          * The sama5d3 does not provide an EBICSA register and thus does need
 702          * to access the matrix registers.
 703          */
 704         if (ebi->caps->ebi_csa) {
 705                 ebi->matrix =
 706                         syscon_regmap_lookup_by_phandle(np, "atmel,matrix");
 707                 if (IS_ERR(ebi->matrix))
 708                         return PTR_ERR(ebi->matrix);
 709
 710                 ebi->ebi_csa = regmap_field_alloc(ebi->matrix,
 711                                                   *ebi->caps->ebi_csa);
 712                 if (IS_ERR(ebi->ebi_csa))
 713                         return PTR_ERR(ebi->ebi_csa);
 714         }
 715
 716         ret = ebi->caps->init(ebi);
 717         if (ret)
 718                 return ret;
 719
 720         ret = of_property_read_u32(np, "#address-cells", &val);
 721         if (ret) {
 722                 dev_err(dev, "missing #address-cells property\n");
 723                 return ret;
 724         }
 725
 726         reg_cells = val;
 727
 728         ret = of_property_read_u32(np, "#size-cells", &val);
 729         if (ret) {
 730                 dev_err(dev, "missing #address-cells property\n");
 731                 return ret;
 732         }
 733
 734         reg_cells += val;
 735
 736         for_each_available_child_of_node(np, child) {
 737                 if (!of_find_property(child, "reg", NULL))
 738                         continue;
 739
 740                 ret = at91_ebi_dev_setup(ebi, child, reg_cells);
 741                 if (ret) {
 742                         dev_err(dev, "failed to configure EBI bus for %s, disabling the device",
 743                                 child->full_name);
 744
 745                         ret = at91_ebi_dev_disable(ebi, child);
 746                         if (ret)
 747                                 return ret;
 748                 }
 749         }
 750
 751         return of_platform_populate(np, NULL, NULL, dev);
 752 }
 753
 754 static struct platform_driver at91_ebi_driver = {
 755         .driver = {
 756                 .name = "atmel-ebi",
 757                 .of_match_table = at91_ebi_id_table,
 758         },
 759 };
 760 builtin_platform_driver_probe(at91_ebi_driver, at91_ebi_probe);