Linux Audio

Check our new training course

Loading...
v6.13.7
  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/cleanup.h>
 10#include <linux/clk.h>
 11#include <linux/io.h>
 12#include <linux/mfd/syscon.h>
 13#include <linux/mfd/syscon/atmel-matrix.h>
 14#include <linux/mfd/syscon/atmel-smc.h>
 15#include <linux/init.h>
 16#include <linux/of.h>
 17#include <linux/of_platform.h>
 18#include <linux/platform_device.h>
 19#include <linux/property.h>
 20#include <linux/regmap.h>
 21#include <soc/at91/atmel-sfr.h>
 22
 23#define AT91_EBI_NUM_CS		8
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 24
 25struct atmel_ebi_dev_config {
 26	int cs;
 27	struct atmel_smc_cs_conf smcconf;
 
 
 28};
 29
 30struct atmel_ebi;
 31
 32struct atmel_ebi_dev {
 33	struct list_head node;
 34	struct atmel_ebi *ebi;
 35	u32 mode;
 36	int numcs;
 37	struct atmel_ebi_dev_config configs[] __counted_by(numcs);
 38};
 39
 40struct atmel_ebi_caps {
 41	unsigned int available_cs;
 42	unsigned int ebi_csa_offs;
 43	const char *regmap_name;
 44	void (*get_config)(struct atmel_ebi_dev *ebid,
 45			   struct atmel_ebi_dev_config *conf);
 46	int (*xlate_config)(struct atmel_ebi_dev *ebid,
 47			    struct device_node *configs_np,
 48			    struct atmel_ebi_dev_config *conf);
 49	void (*apply_config)(struct atmel_ebi_dev *ebid,
 50			     struct atmel_ebi_dev_config *conf);
 
 51};
 52
 53struct atmel_ebi {
 54	struct clk *clk;
 55	struct regmap *regmap;
 56	struct  {
 57		struct regmap *regmap;
 58		struct clk *clk;
 59		const struct atmel_hsmc_reg_layout *layout;
 60	} smc;
 61
 62	struct device *dev;
 63	const struct atmel_ebi_caps *caps;
 64	struct list_head devs;
 
 
 
 65};
 66
 67struct atmel_smc_timing_xlate {
 68	const char *name;
 69	int (*converter)(struct atmel_smc_cs_conf *conf,
 70			 unsigned int shift, unsigned int nycles);
 71	unsigned int shift;
 72};
 73
 74#define ATMEL_SMC_SETUP_XLATE(nm, pos)	\
 75	{ .name = nm, .converter = atmel_smc_cs_conf_set_setup, .shift = pos}
 76
 77#define ATMEL_SMC_PULSE_XLATE(nm, pos)	\
 78	{ .name = nm, .converter = atmel_smc_cs_conf_set_pulse, .shift = pos}
 79
 80#define ATMEL_SMC_CYCLE_XLATE(nm, pos)	\
 81	{ .name = nm, .converter = atmel_smc_cs_conf_set_cycle, .shift = pos}
 82
 83static void at91sam9_ebi_get_config(struct atmel_ebi_dev *ebid,
 84				    struct atmel_ebi_dev_config *conf)
 85{
 86	atmel_smc_cs_conf_get(ebid->ebi->smc.regmap, conf->cs,
 87			      &conf->smcconf);
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 88}
 89
 90static void sama5_ebi_get_config(struct atmel_ebi_dev *ebid,
 91				 struct atmel_ebi_dev_config *conf)
 92{
 93	atmel_hsmc_cs_conf_get(ebid->ebi->smc.regmap, ebid->ebi->smc.layout,
 94			       conf->cs, &conf->smcconf);
 
 
 
 
 
 
 
 95}
 96
 97static const struct atmel_smc_timing_xlate timings_xlate_table[] = {
 98	ATMEL_SMC_SETUP_XLATE("atmel,smc-ncs-rd-setup-ns",
 99			      ATMEL_SMC_NCS_RD_SHIFT),
100	ATMEL_SMC_SETUP_XLATE("atmel,smc-ncs-wr-setup-ns",
101			      ATMEL_SMC_NCS_WR_SHIFT),
102	ATMEL_SMC_SETUP_XLATE("atmel,smc-nrd-setup-ns", ATMEL_SMC_NRD_SHIFT),
103	ATMEL_SMC_SETUP_XLATE("atmel,smc-nwe-setup-ns", ATMEL_SMC_NWE_SHIFT),
104	ATMEL_SMC_PULSE_XLATE("atmel,smc-ncs-rd-pulse-ns",
105			      ATMEL_SMC_NCS_RD_SHIFT),
106	ATMEL_SMC_PULSE_XLATE("atmel,smc-ncs-wr-pulse-ns",
107			      ATMEL_SMC_NCS_WR_SHIFT),
108	ATMEL_SMC_PULSE_XLATE("atmel,smc-nrd-pulse-ns", ATMEL_SMC_NRD_SHIFT),
109	ATMEL_SMC_PULSE_XLATE("atmel,smc-nwe-pulse-ns", ATMEL_SMC_NWE_SHIFT),
110	ATMEL_SMC_CYCLE_XLATE("atmel,smc-nrd-cycle-ns", ATMEL_SMC_NRD_SHIFT),
111	ATMEL_SMC_CYCLE_XLATE("atmel,smc-nwe-cycle-ns", ATMEL_SMC_NWE_SHIFT),
112};
113
114static int atmel_ebi_xslate_smc_timings(struct atmel_ebi_dev *ebid,
115					struct device_node *np,
116					struct atmel_smc_cs_conf *smcconf)
117{
118	unsigned int clk_rate = clk_get_rate(ebid->ebi->clk);
119	unsigned int clk_period_ns = NSEC_PER_SEC / clk_rate;
120	bool required = false;
121	unsigned int ncycles;
122	int ret, i;
123	u32 val;
124
125	ret = of_property_read_u32(np, "atmel,smc-tdf-ns", &val);
126	if (!ret) {
127		required = true;
128		ncycles = DIV_ROUND_UP(val, clk_period_ns);
129		if (ncycles > ATMEL_SMC_MODE_TDF_MAX) {
130			ret = -EINVAL;
131			goto out;
132		}
133
134		if (ncycles < ATMEL_SMC_MODE_TDF_MIN)
135			ncycles = ATMEL_SMC_MODE_TDF_MIN;
 
 
136
137		smcconf->mode |= ATMEL_SMC_MODE_TDF(ncycles);
138	}
 
 
139
140	for (i = 0; i < ARRAY_SIZE(timings_xlate_table); i++) {
141		const struct atmel_smc_timing_xlate *xlate;
 
 
142
143		xlate = &timings_xlate_table[i];
 
 
 
144
145		ret = of_property_read_u32(np, xlate->name, &val);
146		if (ret) {
147			if (!required)
148				continue;
149			else
150				break;
151		}
152
153		if (!required) {
154			ret = -EINVAL;
155			break;
156		}
157
158		ncycles = DIV_ROUND_UP(val, clk_period_ns);
159		ret = xlate->converter(smcconf, xlate->shift, ncycles);
160		if (ret)
161			goto out;
162	}
 
 
 
 
 
 
 
 
 
 
 
 
163
164out:
165	if (ret) {
166		dev_err(ebid->ebi->dev,
167			"missing or invalid timings definition in %pOF",
168			np);
169		return ret;
170	}
171
172	return required;
173}
174
175static int atmel_ebi_xslate_smc_config(struct atmel_ebi_dev *ebid,
176				       struct device_node *np,
177				       struct atmel_ebi_dev_config *conf)
178{
179	struct atmel_smc_cs_conf *smcconf = &conf->smcconf;
180	bool required = false;
181	const char *tmp_str;
182	u32 tmp;
183	int ret;
184
185	ret = of_property_read_u32(np, "atmel,smc-bus-width", &tmp);
186	if (!ret) {
187		switch (tmp) {
188		case 8:
189			smcconf->mode |= ATMEL_SMC_MODE_DBW_8;
190			break;
191
192		case 16:
193			smcconf->mode |= ATMEL_SMC_MODE_DBW_16;
194			break;
195
196		case 32:
197			smcconf->mode |= ATMEL_SMC_MODE_DBW_32;
198			break;
199
200		default:
201			return -EINVAL;
202		}
203
204		required = true;
205	}
206
207	if (of_property_read_bool(np, "atmel,smc-tdf-optimized")) {
208		smcconf->mode |= ATMEL_SMC_MODE_TDFMODE_OPTIMIZED;
209		required = true;
210	}
211
212	tmp_str = NULL;
213	of_property_read_string(np, "atmel,smc-byte-access-type", &tmp_str);
214	if (tmp_str && !strcmp(tmp_str, "write")) {
215		smcconf->mode |= ATMEL_SMC_MODE_BAT_WRITE;
216		required = true;
217	}
218
219	tmp_str = NULL;
220	of_property_read_string(np, "atmel,smc-read-mode", &tmp_str);
221	if (tmp_str && !strcmp(tmp_str, "nrd")) {
222		smcconf->mode |= ATMEL_SMC_MODE_READMODE_NRD;
223		required = true;
224	}
225
226	tmp_str = NULL;
227	of_property_read_string(np, "atmel,smc-write-mode", &tmp_str);
228	if (tmp_str && !strcmp(tmp_str, "nwe")) {
229		smcconf->mode |= ATMEL_SMC_MODE_WRITEMODE_NWE;
230		required = true;
231	}
232
233	tmp_str = NULL;
234	of_property_read_string(np, "atmel,smc-exnw-mode", &tmp_str);
235	if (tmp_str) {
236		if (!strcmp(tmp_str, "frozen"))
237			smcconf->mode |= ATMEL_SMC_MODE_EXNWMODE_FROZEN;
238		else if (!strcmp(tmp_str, "ready"))
239			smcconf->mode |= ATMEL_SMC_MODE_EXNWMODE_READY;
240		else if (strcmp(tmp_str, "disabled"))
241			return -EINVAL;
242
243		required = true;
244	}
245
246	ret = of_property_read_u32(np, "atmel,smc-page-mode", &tmp);
247	if (!ret) {
248		switch (tmp) {
249		case 4:
250			smcconf->mode |= ATMEL_SMC_MODE_PS_4;
251			break;
252
253		case 8:
254			smcconf->mode |= ATMEL_SMC_MODE_PS_8;
255			break;
256
257		case 16:
258			smcconf->mode |= ATMEL_SMC_MODE_PS_16;
259			break;
260
261		case 32:
262			smcconf->mode |= ATMEL_SMC_MODE_PS_32;
263			break;
264
265		default:
266			return -EINVAL;
267		}
268
269		smcconf->mode |= ATMEL_SMC_MODE_PMEN;
270		required = true;
271	}
272
273	ret = atmel_ebi_xslate_smc_timings(ebid, np, &conf->smcconf);
274	if (ret < 0)
275		return -EINVAL;
276
277	if ((ret > 0 && !required) || (!ret && required)) {
278		dev_err(ebid->ebi->dev, "missing atmel,smc- properties in %pOF",
279			np);
280		return -EINVAL;
281	}
282
283	return required;
284}
285
286static void at91sam9_ebi_apply_config(struct atmel_ebi_dev *ebid,
287				      struct atmel_ebi_dev_config *conf)
288{
289	atmel_smc_cs_conf_apply(ebid->ebi->smc.regmap, conf->cs,
290				&conf->smcconf);
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
291}
292
293static void sama5_ebi_apply_config(struct atmel_ebi_dev *ebid,
294				   struct atmel_ebi_dev_config *conf)
295{
296	atmel_hsmc_cs_conf_apply(ebid->ebi->smc.regmap, ebid->ebi->smc.layout,
297				 conf->cs, &conf->smcconf);
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
298}
299
300static int atmel_ebi_dev_setup(struct atmel_ebi *ebi, struct device_node *np,
301			       int reg_cells)
302{
303	const struct atmel_ebi_caps *caps = ebi->caps;
304	struct atmel_ebi_dev_config conf = { };
305	struct device *dev = ebi->dev;
306	struct atmel_ebi_dev *ebid;
307	unsigned long cslines = 0;
308	int ret, numcs = 0, nentries, i;
309	bool apply = false;
310	u32 cs;
311
312	nentries = of_property_count_elems_of_size(np, "reg",
313						   reg_cells * sizeof(u32));
314	for (i = 0; i < nentries; i++) {
315		ret = of_property_read_u32_index(np, "reg", i * reg_cells,
316						 &cs);
317		if (ret)
318			return ret;
319
320		if (cs >= AT91_EBI_NUM_CS ||
321		    !(ebi->caps->available_cs & BIT(cs))) {
322			dev_err(dev, "invalid reg property in %pOF\n", np);
323			return -EINVAL;
324		}
 
 
 
 
 
 
 
 
 
 
 
 
 
 
325
326		if (!test_and_set_bit(cs, &cslines))
327			numcs++;
328	}
 
 
 
 
 
 
329
330	if (!numcs) {
331		dev_err(dev, "invalid reg property in %pOF\n", np);
 
 
332		return -EINVAL;
333	}
334
335	ebid = devm_kzalloc(ebi->dev, struct_size(ebid, configs, numcs),
 
336			    GFP_KERNEL);
337	if (!ebid)
338		return -ENOMEM;
339
340	ebid->ebi = ebi;
341	ebid->numcs = numcs;
342
343	ret = caps->xlate_config(ebid, np, &conf);
344	if (ret < 0)
345		return ret;
346	else if (ret)
347		apply = true;
348
349	i = 0;
350	for_each_set_bit(cs, &cslines, AT91_EBI_NUM_CS) {
 
 
 
 
 
 
 
 
 
 
 
 
 
351		ebid->configs[i].cs = cs;
352
353		if (apply) {
354			conf.cs = cs;
355			caps->apply_config(ebid, &conf);
 
 
356		}
357
358		caps->get_config(ebid, &ebid->configs[i]);
359
360		/*
361		 * Attach the EBI device to the generic SMC logic if at least
362		 * one "atmel,smc-" property is present.
363		 */
364		if (ebi->caps->ebi_csa_offs && apply)
365			regmap_update_bits(ebi->regmap,
366					   ebi->caps->ebi_csa_offs,
367					   BIT(cs), 0);
368
369		i++;
370	}
371
372	list_add_tail(&ebid->node, &ebi->devs);
373
374	return 0;
375}
376
377static const struct atmel_ebi_caps at91sam9260_ebi_caps = {
 
 
 
 
378	.available_cs = 0xff,
379	.ebi_csa_offs = AT91SAM9260_MATRIX_EBICSA,
380	.regmap_name = "atmel,matrix",
381	.get_config = at91sam9_ebi_get_config,
382	.xlate_config = atmel_ebi_xslate_smc_config,
383	.apply_config = at91sam9_ebi_apply_config,
 
384};
385
386static const struct atmel_ebi_caps at91sam9261_ebi_caps = {
 
 
 
 
387	.available_cs = 0xff,
388	.ebi_csa_offs = AT91SAM9261_MATRIX_EBICSA,
389	.regmap_name = "atmel,matrix",
390	.get_config = at91sam9_ebi_get_config,
391	.xlate_config = atmel_ebi_xslate_smc_config,
392	.apply_config = at91sam9_ebi_apply_config,
 
393};
394
395static const struct atmel_ebi_caps at91sam9263_ebi0_caps = {
 
 
 
 
396	.available_cs = 0x3f,
397	.ebi_csa_offs = AT91SAM9263_MATRIX_EBI0CSA,
398	.regmap_name = "atmel,matrix",
399	.get_config = at91sam9_ebi_get_config,
400	.xlate_config = atmel_ebi_xslate_smc_config,
401	.apply_config = at91sam9_ebi_apply_config,
 
402};
403
404static const struct atmel_ebi_caps at91sam9263_ebi1_caps = {
 
 
 
 
405	.available_cs = 0x7,
406	.ebi_csa_offs = AT91SAM9263_MATRIX_EBI1CSA,
407	.regmap_name = "atmel,matrix",
408	.get_config = at91sam9_ebi_get_config,
409	.xlate_config = atmel_ebi_xslate_smc_config,
410	.apply_config = at91sam9_ebi_apply_config,
 
411};
412
413static const struct atmel_ebi_caps at91sam9rl_ebi_caps = {
 
 
 
 
414	.available_cs = 0x3f,
415	.ebi_csa_offs = AT91SAM9RL_MATRIX_EBICSA,
416	.regmap_name = "atmel,matrix",
417	.get_config = at91sam9_ebi_get_config,
418	.xlate_config = atmel_ebi_xslate_smc_config,
419	.apply_config = at91sam9_ebi_apply_config,
 
420};
421
422static const struct atmel_ebi_caps at91sam9g45_ebi_caps = {
 
 
 
 
423	.available_cs = 0x3f,
424	.ebi_csa_offs = AT91SAM9G45_MATRIX_EBICSA,
425	.regmap_name = "atmel,matrix",
426	.get_config = at91sam9_ebi_get_config,
427	.xlate_config = atmel_ebi_xslate_smc_config,
428	.apply_config = at91sam9_ebi_apply_config,
 
429};
430
431static const struct atmel_ebi_caps at91sam9x5_ebi_caps = {
432	.available_cs = 0x3f,
433	.ebi_csa_offs = AT91SAM9X5_MATRIX_EBICSA,
434	.regmap_name = "atmel,matrix",
435	.get_config = at91sam9_ebi_get_config,
436	.xlate_config = atmel_ebi_xslate_smc_config,
437	.apply_config = at91sam9_ebi_apply_config,
 
438};
439
440static const struct atmel_ebi_caps sama5d3_ebi_caps = {
441	.available_cs = 0xf,
442	.get_config = sama5_ebi_get_config,
443	.xlate_config = atmel_ebi_xslate_smc_config,
444	.apply_config = sama5_ebi_apply_config,
445};
446
447static const struct atmel_ebi_caps sam9x60_ebi_caps = {
448	.available_cs = 0x3f,
449	.ebi_csa_offs = AT91_SFR_CCFG_EBICSA,
450	.regmap_name = "microchip,sfr",
451	.get_config = at91sam9_ebi_get_config,
452	.xlate_config = atmel_ebi_xslate_smc_config,
453	.apply_config = at91sam9_ebi_apply_config,
 
454};
455
456static const struct of_device_id atmel_ebi_id_table[] = {
457	{
458		.compatible = "atmel,at91sam9260-ebi",
459		.data = &at91sam9260_ebi_caps,
460	},
461	{
462		.compatible = "atmel,at91sam9261-ebi",
463		.data = &at91sam9261_ebi_caps,
464	},
465	{
466		.compatible = "atmel,at91sam9263-ebi0",
467		.data = &at91sam9263_ebi0_caps,
468	},
469	{
470		.compatible = "atmel,at91sam9263-ebi1",
471		.data = &at91sam9263_ebi1_caps,
472	},
473	{
474		.compatible = "atmel,at91sam9rl-ebi",
475		.data = &at91sam9rl_ebi_caps,
476	},
477	{
478		.compatible = "atmel,at91sam9g45-ebi",
479		.data = &at91sam9g45_ebi_caps,
480	},
481	{
482		.compatible = "atmel,at91sam9x5-ebi",
483		.data = &at91sam9x5_ebi_caps,
484	},
485	{
486		.compatible = "atmel,sama5d3-ebi",
487		.data = &sama5d3_ebi_caps,
488	},
489	{
490		.compatible = "microchip,sam9x60-ebi",
491		.data = &sam9x60_ebi_caps,
492	},
493	{ /* sentinel */ }
494};
495
496static int atmel_ebi_dev_disable(struct atmel_ebi *ebi, struct device_node *np)
497{
498	struct device *dev = ebi->dev;
499	struct property *newprop;
500
501	newprop = devm_kzalloc(dev, sizeof(*newprop), GFP_KERNEL);
502	if (!newprop)
503		return -ENOMEM;
504
505	newprop->name = devm_kstrdup(dev, "status", GFP_KERNEL);
506	if (!newprop->name)
507		return -ENOMEM;
508
509	newprop->value = devm_kstrdup(dev, "disabled", GFP_KERNEL);
510	if (!newprop->value)
511		return -ENOMEM;
512
513	newprop->length = sizeof("disabled");
514
515	return of_update_property(np, newprop);
516}
517
518static int atmel_ebi_probe(struct platform_device *pdev)
519{
520	struct device *dev = &pdev->dev;
521	struct device_node *np = dev->of_node;
522	struct atmel_ebi *ebi;
 
523	int ret, reg_cells;
524	struct clk *clk;
525	u32 val;
526
 
 
 
 
527	ebi = devm_kzalloc(dev, sizeof(*ebi), GFP_KERNEL);
528	if (!ebi)
529		return -ENOMEM;
530
531	platform_set_drvdata(pdev, ebi);
532
533	INIT_LIST_HEAD(&ebi->devs);
534	ebi->caps = device_get_match_data(dev);
535	if (!ebi->caps)
536		return -EINVAL;
537	ebi->dev = dev;
538
539	clk = devm_clk_get(dev, NULL);
540	if (IS_ERR(clk))
541		return PTR_ERR(clk);
542
543	ebi->clk = clk;
544
545	struct device_node *smc_np __free(device_node) =
546		of_parse_phandle(dev->of_node, "atmel,smc", 0);
547
548	ebi->smc.regmap = syscon_node_to_regmap(smc_np);
549	if (IS_ERR(ebi->smc.regmap))
550		return PTR_ERR(ebi->smc.regmap);
551
552	ebi->smc.layout = atmel_hsmc_get_reg_layout(smc_np);
553	if (IS_ERR(ebi->smc.layout))
554		return PTR_ERR(ebi->smc.layout);
555
556	ebi->smc.clk = of_clk_get(smc_np, 0);
557	if (IS_ERR(ebi->smc.clk)) {
558		if (PTR_ERR(ebi->smc.clk) != -ENOENT)
559			return PTR_ERR(ebi->smc.clk);
560
561		ebi->smc.clk = NULL;
562	}
563	ret = clk_prepare_enable(ebi->smc.clk);
564	if (ret)
565		return ret;
566
567	/*
568	 * The sama5d3 does not provide an EBICSA register and thus does need
569	 * to access it.
570	 */
571	if (ebi->caps->ebi_csa_offs) {
572		ebi->regmap =
573			syscon_regmap_lookup_by_phandle(np,
574							ebi->caps->regmap_name);
575		if (IS_ERR(ebi->regmap))
576			return PTR_ERR(ebi->regmap);
 
 
 
 
577	}
578
 
 
 
 
579	ret = of_property_read_u32(np, "#address-cells", &val);
580	if (ret) {
581		dev_err(dev, "missing #address-cells property\n");
582		return ret;
583	}
584
585	reg_cells = val;
586
587	ret = of_property_read_u32(np, "#size-cells", &val);
588	if (ret) {
589		dev_err(dev, "missing #address-cells property\n");
590		return ret;
591	}
592
593	reg_cells += val;
594
595	for_each_available_child_of_node_scoped(np, child) {
596		if (!of_property_present(child, "reg"))
597			continue;
598
599		ret = atmel_ebi_dev_setup(ebi, child, reg_cells);
600		if (ret) {
601			dev_err(dev, "failed to configure EBI bus for %pOF, disabling the device",
602				child);
603
604			ret = atmel_ebi_dev_disable(ebi, child);
605			if (ret)
606				return ret;
607		}
608	}
609
610	return of_platform_populate(np, NULL, NULL, dev);
611}
612
613static __maybe_unused int atmel_ebi_resume(struct device *dev)
614{
615	struct atmel_ebi *ebi = dev_get_drvdata(dev);
616	struct atmel_ebi_dev *ebid;
617
618	list_for_each_entry(ebid, &ebi->devs, node) {
619		int i;
620
621		for (i = 0; i < ebid->numcs; i++)
622			ebid->ebi->caps->apply_config(ebid, &ebid->configs[i]);
623	}
624
625	return 0;
626}
627
628static SIMPLE_DEV_PM_OPS(atmel_ebi_pm_ops, NULL, atmel_ebi_resume);
629
630static struct platform_driver atmel_ebi_driver = {
631	.driver = {
632		.name = "atmel-ebi",
633		.of_match_table	= atmel_ebi_id_table,
634		.pm = &atmel_ebi_pm_ops,
635	},
636};
637builtin_platform_driver_probe(atmel_ebi_driver, atmel_ebi_probe);
v4.10.11
 
  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);