[mirror_ubuntu-eoan-kernel.git] / drivers / memory / atmel-ebi.c

/*
 * EBI driver for Atmel chips
 * inspired by the fsl weim bus driver
 *
 * Copyright (C) 2013 Jean-Jacques Hiblot <jjhiblot@traphandler.com>
 *
 * This file is licensed under the terms of the GNU General Public
 * License version 2. This program is licensed "as is" without any
 * warranty of any kind, whether express or implied.
 */

#include <linux/clk.h>
#include <linux/io.h>
#include <linux/mfd/syscon.h>
#include <linux/mfd/syscon/atmel-matrix.h>
#include <linux/mfd/syscon/atmel-smc.h>
#include <linux/init.h>
#include <linux/of_device.h>
#include <linux/regmap.h>
#include <soc/at91/atmel-sfr.h>

struct atmel_ebi_dev_config {
	int cs;
	struct atmel_smc_cs_conf smcconf;
};

struct atmel_ebi;

struct atmel_ebi_dev {
	struct list_head node;
	struct atmel_ebi *ebi;
	u32 mode;
	int numcs;
	struct atmel_ebi_dev_config configs[];
};

struct atmel_ebi_caps {
	unsigned int available_cs;
	unsigned int ebi_csa_offs;
	const char *regmap_name;
	void (*get_config)(struct atmel_ebi_dev *ebid,
			   struct atmel_ebi_dev_config *conf);
	int (*xlate_config)(struct atmel_ebi_dev *ebid,
			    struct device_node *configs_np,
			    struct atmel_ebi_dev_config *conf);
	void (*apply_config)(struct atmel_ebi_dev *ebid,
			     struct atmel_ebi_dev_config *conf);
};

struct atmel_ebi {
	struct clk *clk;
	struct regmap *regmap;
	struct  {
		struct regmap *regmap;
		struct clk *clk;
		const struct atmel_hsmc_reg_layout *layout;
	} smc;

	struct device *dev;
	const struct atmel_ebi_caps *caps;
	struct list_head devs;
};

struct atmel_smc_timing_xlate {
	const char *name;
	int (*converter)(struct atmel_smc_cs_conf *conf,
			 unsigned int shift, unsigned int nycles);
	unsigned int shift;
};

#define ATMEL_SMC_SETUP_XLATE(nm, pos)	\
	{ .name = nm, .converter = atmel_smc_cs_conf_set_setup, .shift = pos}

#define ATMEL_SMC_PULSE_XLATE(nm, pos)	\
	{ .name = nm, .converter = atmel_smc_cs_conf_set_pulse, .shift = pos}

#define ATMEL_SMC_CYCLE_XLATE(nm, pos)	\
	{ .name = nm, .converter = atmel_smc_cs_conf_set_cycle, .shift = pos}

static void at91sam9_ebi_get_config(struct atmel_ebi_dev *ebid,
				    struct atmel_ebi_dev_config *conf)
{
	atmel_smc_cs_conf_get(ebid->ebi->smc.regmap, conf->cs,
			      &conf->smcconf);
}

static void sama5_ebi_get_config(struct atmel_ebi_dev *ebid,
				 struct atmel_ebi_dev_config *conf)
{
	atmel_hsmc_cs_conf_get(ebid->ebi->smc.regmap, ebid->ebi->smc.layout,
			       conf->cs, &conf->smcconf);
}

static const struct atmel_smc_timing_xlate timings_xlate_table[] = {
	ATMEL_SMC_SETUP_XLATE("atmel,smc-ncs-rd-setup-ns",
			      ATMEL_SMC_NCS_RD_SHIFT),
	ATMEL_SMC_SETUP_XLATE("atmel,smc-ncs-wr-setup-ns",
			      ATMEL_SMC_NCS_WR_SHIFT),
	ATMEL_SMC_SETUP_XLATE("atmel,smc-nrd-setup-ns", ATMEL_SMC_NRD_SHIFT),
	ATMEL_SMC_SETUP_XLATE("atmel,smc-nwe-setup-ns", ATMEL_SMC_NWE_SHIFT),
	ATMEL_SMC_PULSE_XLATE("atmel,smc-ncs-rd-pulse-ns",
			      ATMEL_SMC_NCS_RD_SHIFT),
	ATMEL_SMC_PULSE_XLATE("atmel,smc-ncs-wr-pulse-ns",
			      ATMEL_SMC_NCS_WR_SHIFT),
	ATMEL_SMC_PULSE_XLATE("atmel,smc-nrd-pulse-ns", ATMEL_SMC_NRD_SHIFT),
	ATMEL_SMC_PULSE_XLATE("atmel,smc-nwe-pulse-ns", ATMEL_SMC_NWE_SHIFT),
	ATMEL_SMC_CYCLE_XLATE("atmel,smc-nrd-cycle-ns", ATMEL_SMC_NRD_SHIFT),
	ATMEL_SMC_CYCLE_XLATE("atmel,smc-nwe-cycle-ns", ATMEL_SMC_NWE_SHIFT),
};

static int atmel_ebi_xslate_smc_timings(struct atmel_ebi_dev *ebid,
					struct device_node *np,
					struct atmel_smc_cs_conf *smcconf)
{
	unsigned int clk_rate = clk_get_rate(ebid->ebi->clk);
	unsigned int clk_period_ns = NSEC_PER_SEC / clk_rate;
	bool required = false;
	unsigned int ncycles;
	int ret, i;
	u32 val;

	ret = of_property_read_u32(np, "atmel,smc-tdf-ns", &val);
	if (!ret) {
		required = true;
		ncycles = DIV_ROUND_UP(val, clk_period_ns);
		if (ncycles > ATMEL_SMC_MODE_TDF_MAX) {
			ret = -EINVAL;
			goto out;
		}

		if (ncycles < ATMEL_SMC_MODE_TDF_MIN)
			ncycles = ATMEL_SMC_MODE_TDF_MIN;

		smcconf->mode |= ATMEL_SMC_MODE_TDF(ncycles);
	}

	for (i = 0; i < ARRAY_SIZE(timings_xlate_table); i++) {
		const struct atmel_smc_timing_xlate *xlate;

		xlate = &timings_xlate_table[i];

		ret = of_property_read_u32(np, xlate->name, &val);
		if (ret) {
			if (!required)
				continue;
			else
				break;
		}

		if (!required) {
			ret = -EINVAL;
			break;
		}

		ncycles = DIV_ROUND_UP(val, clk_period_ns);
		ret = xlate->converter(smcconf, xlate->shift, ncycles);
		if (ret)
			goto out;
	}

out:
	if (ret) {
		dev_err(ebid->ebi->dev,
			"missing or invalid timings definition in %pOF",
			np);
		return ret;
	}

	return required;
}

static int atmel_ebi_xslate_smc_config(struct atmel_ebi_dev *ebid,
				       struct device_node *np,
				       struct atmel_ebi_dev_config *conf)
{
	struct atmel_smc_cs_conf *smcconf = &conf->smcconf;
	bool required = false;
	const char *tmp_str;
	u32 tmp;
	int ret;

	ret = of_property_read_u32(np, "atmel,smc-bus-width", &tmp);
	if (!ret) {
		switch (tmp) {
		case 8:
			smcconf->mode |= ATMEL_SMC_MODE_DBW_8;
			break;

		case 16:
			smcconf->mode |= ATMEL_SMC_MODE_DBW_16;
			break;

		case 32:
			smcconf->mode |= ATMEL_SMC_MODE_DBW_32;
			break;

		default:
			return -EINVAL;
		}

		required = true;
	}

	if (of_property_read_bool(np, "atmel,smc-tdf-optimized")) {
		smcconf->mode |= ATMEL_SMC_MODE_TDFMODE_OPTIMIZED;
		required = true;
	}

	tmp_str = NULL;
	of_property_read_string(np, "atmel,smc-byte-access-type", &tmp_str);
	if (tmp_str && !strcmp(tmp_str, "write")) {
		smcconf->mode |= ATMEL_SMC_MODE_BAT_WRITE;
		required = true;
	}

	tmp_str = NULL;
	of_property_read_string(np, "atmel,smc-read-mode", &tmp_str);
	if (tmp_str && !strcmp(tmp_str, "nrd")) {
		smcconf->mode |= ATMEL_SMC_MODE_READMODE_NRD;
		required = true;
	}

	tmp_str = NULL;
	of_property_read_string(np, "atmel,smc-write-mode", &tmp_str);
	if (tmp_str && !strcmp(tmp_str, "nwe")) {
		smcconf->mode |= ATMEL_SMC_MODE_WRITEMODE_NWE;
		required = true;
	}

	tmp_str = NULL;
	of_property_read_string(np, "atmel,smc-exnw-mode", &tmp_str);
	if (tmp_str) {
		if (!strcmp(tmp_str, "frozen"))
			smcconf->mode |= ATMEL_SMC_MODE_EXNWMODE_FROZEN;
		else if (!strcmp(tmp_str, "ready"))
			smcconf->mode |= ATMEL_SMC_MODE_EXNWMODE_READY;
		else if (strcmp(tmp_str, "disabled"))
			return -EINVAL;

		required = true;
	}

	ret = of_property_read_u32(np, "atmel,smc-page-mode", &tmp);
	if (!ret) {
		switch (tmp) {
		case 4:
			smcconf->mode |= ATMEL_SMC_MODE_PS_4;
			break;

		case 8:
			smcconf->mode |= ATMEL_SMC_MODE_PS_8;
			break;

		case 16:
			smcconf->mode |= ATMEL_SMC_MODE_PS_16;
			break;

		case 32:
			smcconf->mode |= ATMEL_SMC_MODE_PS_32;
			break;

		default:
			return -EINVAL;
		}

		smcconf->mode |= ATMEL_SMC_MODE_PMEN;
		required = true;
	}

	ret = atmel_ebi_xslate_smc_timings(ebid, np, &conf->smcconf);
	if (ret < 0)
		return -EINVAL;

	if ((ret > 0 && !required) || (!ret && required)) {
		dev_err(ebid->ebi->dev, "missing atmel,smc- properties in %pOF",
			np);
		return -EINVAL;
	}

	return required;
}

static void at91sam9_ebi_apply_config(struct atmel_ebi_dev *ebid,
				      struct atmel_ebi_dev_config *conf)
{
	atmel_smc_cs_conf_apply(ebid->ebi->smc.regmap, conf->cs,
				&conf->smcconf);
}

static void sama5_ebi_apply_config(struct atmel_ebi_dev *ebid,
				   struct atmel_ebi_dev_config *conf)
{
	atmel_hsmc_cs_conf_apply(ebid->ebi->smc.regmap, ebid->ebi->smc.layout,
				 conf->cs, &conf->smcconf);
}

static int atmel_ebi_dev_setup(struct atmel_ebi *ebi, struct device_node *np,
			       int reg_cells)
{
	const struct atmel_ebi_caps *caps = ebi->caps;
	struct atmel_ebi_dev_config conf = { };
	struct device *dev = ebi->dev;
	struct atmel_ebi_dev *ebid;
	unsigned long cslines = 0;
	int ret, numcs = 0, nentries, i;
	bool apply = false;
	u32 cs;

	nentries = of_property_count_elems_of_size(np, "reg",
						   reg_cells * sizeof(u32));
	for (i = 0; i < nentries; i++) {
		ret = of_property_read_u32_index(np, "reg", i * reg_cells,
						 &cs);
		if (ret)
			return ret;

		if (cs >= AT91_MATRIX_EBI_NUM_CS ||
		    !(ebi->caps->available_cs & BIT(cs))) {
			dev_err(dev, "invalid reg property in %pOF\n", np);
			return -EINVAL;
		}

		if (!test_and_set_bit(cs, &cslines))
			numcs++;
	}

	if (!numcs) {
		dev_err(dev, "invalid reg property in %pOF\n", np);
		return -EINVAL;
	}

	ebid = devm_kzalloc(ebi->dev, struct_size(ebid, configs, numcs),
			    GFP_KERNEL);
	if (!ebid)
		return -ENOMEM;

	ebid->ebi = ebi;
	ebid->numcs = numcs;

	ret = caps->xlate_config(ebid, np, &conf);
	if (ret < 0)
		return ret;
	else if (ret)
		apply = true;

	i = 0;
	for_each_set_bit(cs, &cslines, AT91_MATRIX_EBI_NUM_CS) {
		ebid->configs[i].cs = cs;

		if (apply) {
			conf.cs = cs;
			caps->apply_config(ebid, &conf);
		}

		caps->get_config(ebid, &ebid->configs[i]);

		/*
		 * Attach the EBI device to the generic SMC logic if at least
		 * one "atmel,smc-" property is present.
		 */
		if (ebi->caps->ebi_csa_offs && apply)
			regmap_update_bits(ebi->regmap,
					   ebi->caps->ebi_csa_offs,
					   BIT(cs), 0);

		i++;
	}

	list_add_tail(&ebid->node, &ebi->devs);

	return 0;
}

static const struct atmel_ebi_caps at91sam9260_ebi_caps = {
	.available_cs = 0xff,
	.ebi_csa_offs = AT91SAM9260_MATRIX_EBICSA,
	.regmap_name = "atmel,matrix",
	.get_config = at91sam9_ebi_get_config,
	.xlate_config = atmel_ebi_xslate_smc_config,
	.apply_config = at91sam9_ebi_apply_config,
};

static const struct atmel_ebi_caps at91sam9261_ebi_caps = {
	.available_cs = 0xff,
	.ebi_csa_offs = AT91SAM9261_MATRIX_EBICSA,
	.regmap_name = "atmel,matrix",
	.get_config = at91sam9_ebi_get_config,
	.xlate_config = atmel_ebi_xslate_smc_config,
	.apply_config = at91sam9_ebi_apply_config,
};

static const struct atmel_ebi_caps at91sam9263_ebi0_caps = {
	.available_cs = 0x3f,
	.ebi_csa_offs = AT91SAM9263_MATRIX_EBI0CSA,
	.regmap_name = "atmel,matrix",
	.get_config = at91sam9_ebi_get_config,
	.xlate_config = atmel_ebi_xslate_smc_config,
	.apply_config = at91sam9_ebi_apply_config,
};

static const struct atmel_ebi_caps at91sam9263_ebi1_caps = {
	.available_cs = 0x7,
	.ebi_csa_offs = AT91SAM9263_MATRIX_EBI1CSA,
	.regmap_name = "atmel,matrix",
	.get_config = at91sam9_ebi_get_config,
	.xlate_config = atmel_ebi_xslate_smc_config,
	.apply_config = at91sam9_ebi_apply_config,
};

static const struct atmel_ebi_caps at91sam9rl_ebi_caps = {
	.available_cs = 0x3f,
	.ebi_csa_offs = AT91SAM9RL_MATRIX_EBICSA,
	.regmap_name = "atmel,matrix",
	.get_config = at91sam9_ebi_get_config,
	.xlate_config = atmel_ebi_xslate_smc_config,
	.apply_config = at91sam9_ebi_apply_config,
};

static const struct atmel_ebi_caps at91sam9g45_ebi_caps = {
	.available_cs = 0x3f,
	.ebi_csa_offs = AT91SAM9G45_MATRIX_EBICSA,
	.regmap_name = "atmel,matrix",
	.get_config = at91sam9_ebi_get_config,
	.xlate_config = atmel_ebi_xslate_smc_config,
	.apply_config = at91sam9_ebi_apply_config,
};

static const struct atmel_ebi_caps at91sam9x5_ebi_caps = {
	.available_cs = 0x3f,
	.ebi_csa_offs = AT91SAM9X5_MATRIX_EBICSA,
	.regmap_name = "atmel,matrix",
	.get_config = at91sam9_ebi_get_config,
	.xlate_config = atmel_ebi_xslate_smc_config,
	.apply_config = at91sam9_ebi_apply_config,
};

static const struct atmel_ebi_caps sama5d3_ebi_caps = {
	.available_cs = 0xf,
	.get_config = sama5_ebi_get_config,
	.xlate_config = atmel_ebi_xslate_smc_config,
	.apply_config = sama5_ebi_apply_config,
};

static const struct atmel_ebi_caps sam9x60_ebi_caps = {
	.available_cs = 0x3f,
	.ebi_csa_offs = AT91_SFR_CCFG_EBICSA,
	.regmap_name = "microchip,sfr",
	.get_config = at91sam9_ebi_get_config,
	.xlate_config = atmel_ebi_xslate_smc_config,
	.apply_config = at91sam9_ebi_apply_config,
};

static const struct of_device_id atmel_ebi_id_table[] = {
	{
		.compatible = "atmel,at91sam9260-ebi",
		.data = &at91sam9260_ebi_caps,
	},
	{
		.compatible = "atmel,at91sam9261-ebi",
		.data = &at91sam9261_ebi_caps,
	},
	{
		.compatible = "atmel,at91sam9263-ebi0",
		.data = &at91sam9263_ebi0_caps,
	},
	{
		.compatible = "atmel,at91sam9263-ebi1",
		.data = &at91sam9263_ebi1_caps,
	},
	{
		.compatible = "atmel,at91sam9rl-ebi",
		.data = &at91sam9rl_ebi_caps,
	},
	{
		.compatible = "atmel,at91sam9g45-ebi",
		.data = &at91sam9g45_ebi_caps,
	},
	{
		.compatible = "atmel,at91sam9x5-ebi",
		.data = &at91sam9x5_ebi_caps,
	},
	{
		.compatible = "atmel,sama5d3-ebi",
		.data = &sama5d3_ebi_caps,
	},
	{
		.compatible = "microchip,sam9x60-ebi",
		.data = &sam9x60_ebi_caps,
	},
	{ /* sentinel */ }
};

static int atmel_ebi_dev_disable(struct atmel_ebi *ebi, struct device_node *np)
{
	struct device *dev = ebi->dev;
	struct property *newprop;

	newprop = devm_kzalloc(dev, sizeof(*newprop), GFP_KERNEL);
	if (!newprop)
		return -ENOMEM;

	newprop->name = devm_kstrdup(dev, "status", GFP_KERNEL);
	if (!newprop->name)
		return -ENOMEM;

	newprop->value = devm_kstrdup(dev, "disabled", GFP_KERNEL);
	if (!newprop->value)
		return -ENOMEM;

	newprop->length = sizeof("disabled");

	return of_update_property(np, newprop);
}

static int atmel_ebi_probe(struct platform_device *pdev)
{
	struct device *dev = &pdev->dev;
	struct device_node *child, *np = dev->of_node, *smc_np;
	const struct of_device_id *match;
	struct atmel_ebi *ebi;
	int ret, reg_cells;
	struct clk *clk;
	u32 val;

	match = of_match_device(atmel_ebi_id_table, dev);
	if (!match || !match->data)
		return -EINVAL;

	ebi = devm_kzalloc(dev, sizeof(*ebi), GFP_KERNEL);
	if (!ebi)
		return -ENOMEM;

	platform_set_drvdata(pdev, ebi);

	INIT_LIST_HEAD(&ebi->devs);
	ebi->caps = match->data;
	ebi->dev = dev;

	clk = devm_clk_get(dev, NULL);
	if (IS_ERR(clk))
		return PTR_ERR(clk);

	ebi->clk = clk;

	smc_np = of_parse_phandle(dev->of_node, "atmel,smc", 0);

	ebi->smc.regmap = syscon_node_to_regmap(smc_np);
	if (IS_ERR(ebi->smc.regmap))
		return PTR_ERR(ebi->smc.regmap);

	ebi->smc.layout = atmel_hsmc_get_reg_layout(smc_np);
	if (IS_ERR(ebi->smc.layout))
		return PTR_ERR(ebi->smc.layout);

	ebi->smc.clk = of_clk_get(smc_np, 0);
	if (IS_ERR(ebi->smc.clk)) {
		if (PTR_ERR(ebi->smc.clk) != -ENOENT)
			return PTR_ERR(ebi->smc.clk);

		ebi->smc.clk = NULL;
	}
	ret = clk_prepare_enable(ebi->smc.clk);
	if (ret)
		return ret;

	/*
	 * The sama5d3 does not provide an EBICSA register and thus does need
	 * to access it.
	 */
	if (ebi->caps->ebi_csa_offs) {
		ebi->regmap =
			syscon_regmap_lookup_by_phandle(np,
							ebi->caps->regmap_name);
		if (IS_ERR(ebi->regmap))
			return PTR_ERR(ebi->regmap);
	}

	ret = of_property_read_u32(np, "#address-cells", &val);
	if (ret) {
		dev_err(dev, "missing #address-cells property\n");
		return ret;
	}

	reg_cells = val;

	ret = of_property_read_u32(np, "#size-cells", &val);
	if (ret) {
		dev_err(dev, "missing #address-cells property\n");
		return ret;
	}

	reg_cells += val;

	for_each_available_child_of_node(np, child) {
		if (!of_find_property(child, "reg", NULL))
			continue;

		ret = atmel_ebi_dev_setup(ebi, child, reg_cells);
		if (ret) {
			dev_err(dev, "failed to configure EBI bus for %pOF, disabling the device",
				child);

			ret = atmel_ebi_dev_disable(ebi, child);
			if (ret)
				return ret;
		}
	}

	return of_platform_populate(np, NULL, NULL, dev);
}

static __maybe_unused int atmel_ebi_resume(struct device *dev)
{
	struct atmel_ebi *ebi = dev_get_drvdata(dev);
	struct atmel_ebi_dev *ebid;

	list_for_each_entry(ebid, &ebi->devs, node) {
		int i;

		for (i = 0; i < ebid->numcs; i++)
			ebid->ebi->caps->apply_config(ebid, &ebid->configs[i]);
	}

	return 0;
}

static SIMPLE_DEV_PM_OPS(atmel_ebi_pm_ops, NULL, atmel_ebi_resume);

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