162306a36Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0-only
262306a36Sopenharmony_ci/*
362306a36Sopenharmony_ci * TI AEMIF driver
462306a36Sopenharmony_ci *
562306a36Sopenharmony_ci * Copyright (C) 2010 - 2013 Texas Instruments Incorporated. http://www.ti.com/
662306a36Sopenharmony_ci *
762306a36Sopenharmony_ci * Authors:
862306a36Sopenharmony_ci * Murali Karicheri <m-karicheri2@ti.com>
962306a36Sopenharmony_ci * Ivan Khoronzhuk <ivan.khoronzhuk@ti.com>
1062306a36Sopenharmony_ci */
1162306a36Sopenharmony_ci
1262306a36Sopenharmony_ci#include <linux/clk.h>
1362306a36Sopenharmony_ci#include <linux/err.h>
1462306a36Sopenharmony_ci#include <linux/io.h>
1562306a36Sopenharmony_ci#include <linux/kernel.h>
1662306a36Sopenharmony_ci#include <linux/module.h>
1762306a36Sopenharmony_ci#include <linux/of.h>
1862306a36Sopenharmony_ci#include <linux/of_platform.h>
1962306a36Sopenharmony_ci#include <linux/platform_device.h>
2062306a36Sopenharmony_ci#include <linux/platform_data/ti-aemif.h>
2162306a36Sopenharmony_ci
2262306a36Sopenharmony_ci#define TA_SHIFT	2
2362306a36Sopenharmony_ci#define RHOLD_SHIFT	4
2462306a36Sopenharmony_ci#define RSTROBE_SHIFT	7
2562306a36Sopenharmony_ci#define RSETUP_SHIFT	13
2662306a36Sopenharmony_ci#define WHOLD_SHIFT	17
2762306a36Sopenharmony_ci#define WSTROBE_SHIFT	20
2862306a36Sopenharmony_ci#define WSETUP_SHIFT	26
2962306a36Sopenharmony_ci#define EW_SHIFT	30
3062306a36Sopenharmony_ci#define SSTROBE_SHIFT	31
3162306a36Sopenharmony_ci
3262306a36Sopenharmony_ci#define TA(x)		((x) << TA_SHIFT)
3362306a36Sopenharmony_ci#define RHOLD(x)	((x) << RHOLD_SHIFT)
3462306a36Sopenharmony_ci#define RSTROBE(x)	((x) << RSTROBE_SHIFT)
3562306a36Sopenharmony_ci#define RSETUP(x)	((x) << RSETUP_SHIFT)
3662306a36Sopenharmony_ci#define WHOLD(x)	((x) << WHOLD_SHIFT)
3762306a36Sopenharmony_ci#define WSTROBE(x)	((x) << WSTROBE_SHIFT)
3862306a36Sopenharmony_ci#define WSETUP(x)	((x) << WSETUP_SHIFT)
3962306a36Sopenharmony_ci#define EW(x)		((x) << EW_SHIFT)
4062306a36Sopenharmony_ci#define SSTROBE(x)	((x) << SSTROBE_SHIFT)
4162306a36Sopenharmony_ci
4262306a36Sopenharmony_ci#define ASIZE_MAX	0x1
4362306a36Sopenharmony_ci#define TA_MAX		0x3
4462306a36Sopenharmony_ci#define RHOLD_MAX	0x7
4562306a36Sopenharmony_ci#define RSTROBE_MAX	0x3f
4662306a36Sopenharmony_ci#define RSETUP_MAX	0xf
4762306a36Sopenharmony_ci#define WHOLD_MAX	0x7
4862306a36Sopenharmony_ci#define WSTROBE_MAX	0x3f
4962306a36Sopenharmony_ci#define WSETUP_MAX	0xf
5062306a36Sopenharmony_ci#define EW_MAX		0x1
5162306a36Sopenharmony_ci#define SSTROBE_MAX	0x1
5262306a36Sopenharmony_ci#define NUM_CS		4
5362306a36Sopenharmony_ci
5462306a36Sopenharmony_ci#define TA_VAL(x)	(((x) & TA(TA_MAX)) >> TA_SHIFT)
5562306a36Sopenharmony_ci#define RHOLD_VAL(x)	(((x) & RHOLD(RHOLD_MAX)) >> RHOLD_SHIFT)
5662306a36Sopenharmony_ci#define RSTROBE_VAL(x)	(((x) & RSTROBE(RSTROBE_MAX)) >> RSTROBE_SHIFT)
5762306a36Sopenharmony_ci#define RSETUP_VAL(x)	(((x) & RSETUP(RSETUP_MAX)) >> RSETUP_SHIFT)
5862306a36Sopenharmony_ci#define WHOLD_VAL(x)	(((x) & WHOLD(WHOLD_MAX)) >> WHOLD_SHIFT)
5962306a36Sopenharmony_ci#define WSTROBE_VAL(x)	(((x) & WSTROBE(WSTROBE_MAX)) >> WSTROBE_SHIFT)
6062306a36Sopenharmony_ci#define WSETUP_VAL(x)	(((x) & WSETUP(WSETUP_MAX)) >> WSETUP_SHIFT)
6162306a36Sopenharmony_ci#define EW_VAL(x)	(((x) & EW(EW_MAX)) >> EW_SHIFT)
6262306a36Sopenharmony_ci#define SSTROBE_VAL(x)	(((x) & SSTROBE(SSTROBE_MAX)) >> SSTROBE_SHIFT)
6362306a36Sopenharmony_ci
6462306a36Sopenharmony_ci#define NRCSR_OFFSET	0x00
6562306a36Sopenharmony_ci#define AWCCR_OFFSET	0x04
6662306a36Sopenharmony_ci#define A1CR_OFFSET	0x10
6762306a36Sopenharmony_ci
6862306a36Sopenharmony_ci#define ACR_ASIZE_MASK	0x3
6962306a36Sopenharmony_ci#define ACR_EW_MASK	BIT(30)
7062306a36Sopenharmony_ci#define ACR_SSTROBE_MASK	BIT(31)
7162306a36Sopenharmony_ci#define ASIZE_16BIT	1
7262306a36Sopenharmony_ci
7362306a36Sopenharmony_ci#define CONFIG_MASK	(TA(TA_MAX) | \
7462306a36Sopenharmony_ci				RHOLD(RHOLD_MAX) | \
7562306a36Sopenharmony_ci				RSTROBE(RSTROBE_MAX) |	\
7662306a36Sopenharmony_ci				RSETUP(RSETUP_MAX) | \
7762306a36Sopenharmony_ci				WHOLD(WHOLD_MAX) | \
7862306a36Sopenharmony_ci				WSTROBE(WSTROBE_MAX) | \
7962306a36Sopenharmony_ci				WSETUP(WSETUP_MAX) | \
8062306a36Sopenharmony_ci				EW(EW_MAX) | SSTROBE(SSTROBE_MAX) | \
8162306a36Sopenharmony_ci				ASIZE_MAX)
8262306a36Sopenharmony_ci
8362306a36Sopenharmony_ci/**
8462306a36Sopenharmony_ci * struct aemif_cs_data: structure to hold cs parameters
8562306a36Sopenharmony_ci * @cs: chip-select number
8662306a36Sopenharmony_ci * @wstrobe: write strobe width, ns
8762306a36Sopenharmony_ci * @rstrobe: read strobe width, ns
8862306a36Sopenharmony_ci * @wsetup: write setup width, ns
8962306a36Sopenharmony_ci * @whold: write hold width, ns
9062306a36Sopenharmony_ci * @rsetup: read setup width, ns
9162306a36Sopenharmony_ci * @rhold: read hold width, ns
9262306a36Sopenharmony_ci * @ta: minimum turn around time, ns
9362306a36Sopenharmony_ci * @enable_ss: enable/disable select strobe mode
9462306a36Sopenharmony_ci * @enable_ew: enable/disable extended wait mode
9562306a36Sopenharmony_ci * @asize: width of the asynchronous device's data bus
9662306a36Sopenharmony_ci */
9762306a36Sopenharmony_cistruct aemif_cs_data {
9862306a36Sopenharmony_ci	u8	cs;
9962306a36Sopenharmony_ci	u16	wstrobe;
10062306a36Sopenharmony_ci	u16	rstrobe;
10162306a36Sopenharmony_ci	u8	wsetup;
10262306a36Sopenharmony_ci	u8	whold;
10362306a36Sopenharmony_ci	u8	rsetup;
10462306a36Sopenharmony_ci	u8	rhold;
10562306a36Sopenharmony_ci	u8	ta;
10662306a36Sopenharmony_ci	u8	enable_ss;
10762306a36Sopenharmony_ci	u8	enable_ew;
10862306a36Sopenharmony_ci	u8	asize;
10962306a36Sopenharmony_ci};
11062306a36Sopenharmony_ci
11162306a36Sopenharmony_ci/**
11262306a36Sopenharmony_ci * struct aemif_device: structure to hold device data
11362306a36Sopenharmony_ci * @base: base address of AEMIF registers
11462306a36Sopenharmony_ci * @clk: source clock
11562306a36Sopenharmony_ci * @clk_rate: clock's rate in kHz
11662306a36Sopenharmony_ci * @num_cs: number of assigned chip-selects
11762306a36Sopenharmony_ci * @cs_offset: start number of cs nodes
11862306a36Sopenharmony_ci * @cs_data: array of chip-select settings
11962306a36Sopenharmony_ci */
12062306a36Sopenharmony_cistruct aemif_device {
12162306a36Sopenharmony_ci	void __iomem *base;
12262306a36Sopenharmony_ci	struct clk *clk;
12362306a36Sopenharmony_ci	unsigned long clk_rate;
12462306a36Sopenharmony_ci	u8 num_cs;
12562306a36Sopenharmony_ci	int cs_offset;
12662306a36Sopenharmony_ci	struct aemif_cs_data cs_data[NUM_CS];
12762306a36Sopenharmony_ci};
12862306a36Sopenharmony_ci
12962306a36Sopenharmony_ci/**
13062306a36Sopenharmony_ci * aemif_calc_rate - calculate timing data.
13162306a36Sopenharmony_ci * @pdev: platform device to calculate for
13262306a36Sopenharmony_ci * @wanted: The cycle time needed in nanoseconds.
13362306a36Sopenharmony_ci * @clk: The input clock rate in kHz.
13462306a36Sopenharmony_ci * @max: The maximum divider value that can be programmed.
13562306a36Sopenharmony_ci *
13662306a36Sopenharmony_ci * On success, returns the calculated timing value minus 1 for easy
13762306a36Sopenharmony_ci * programming into AEMIF timing registers, else negative errno.
13862306a36Sopenharmony_ci */
13962306a36Sopenharmony_cistatic int aemif_calc_rate(struct platform_device *pdev, int wanted,
14062306a36Sopenharmony_ci			   unsigned long clk, int max)
14162306a36Sopenharmony_ci{
14262306a36Sopenharmony_ci	int result;
14362306a36Sopenharmony_ci
14462306a36Sopenharmony_ci	result = DIV_ROUND_UP((wanted * clk), NSEC_PER_MSEC) - 1;
14562306a36Sopenharmony_ci
14662306a36Sopenharmony_ci	dev_dbg(&pdev->dev, "%s: result %d from %ld, %d\n", __func__, result,
14762306a36Sopenharmony_ci		clk, wanted);
14862306a36Sopenharmony_ci
14962306a36Sopenharmony_ci	/* It is generally OK to have a more relaxed timing than requested... */
15062306a36Sopenharmony_ci	if (result < 0)
15162306a36Sopenharmony_ci		result = 0;
15262306a36Sopenharmony_ci
15362306a36Sopenharmony_ci	/* ... But configuring tighter timings is not an option. */
15462306a36Sopenharmony_ci	else if (result > max)
15562306a36Sopenharmony_ci		result = -EINVAL;
15662306a36Sopenharmony_ci
15762306a36Sopenharmony_ci	return result;
15862306a36Sopenharmony_ci}
15962306a36Sopenharmony_ci
16062306a36Sopenharmony_ci/**
16162306a36Sopenharmony_ci * aemif_config_abus - configure async bus parameters
16262306a36Sopenharmony_ci * @pdev: platform device to configure for
16362306a36Sopenharmony_ci * @csnum: aemif chip select number
16462306a36Sopenharmony_ci *
16562306a36Sopenharmony_ci * This function programs the given timing values (in real clock) into the
16662306a36Sopenharmony_ci * AEMIF registers taking the AEMIF clock into account.
16762306a36Sopenharmony_ci *
16862306a36Sopenharmony_ci * This function does not use any locking while programming the AEMIF
16962306a36Sopenharmony_ci * because it is expected that there is only one user of a given
17062306a36Sopenharmony_ci * chip-select.
17162306a36Sopenharmony_ci *
17262306a36Sopenharmony_ci * Returns 0 on success, else negative errno.
17362306a36Sopenharmony_ci */
17462306a36Sopenharmony_cistatic int aemif_config_abus(struct platform_device *pdev, int csnum)
17562306a36Sopenharmony_ci{
17662306a36Sopenharmony_ci	struct aemif_device *aemif = platform_get_drvdata(pdev);
17762306a36Sopenharmony_ci	struct aemif_cs_data *data = &aemif->cs_data[csnum];
17862306a36Sopenharmony_ci	int ta, rhold, rstrobe, rsetup, whold, wstrobe, wsetup;
17962306a36Sopenharmony_ci	unsigned long clk_rate = aemif->clk_rate;
18062306a36Sopenharmony_ci	unsigned offset;
18162306a36Sopenharmony_ci	u32 set, val;
18262306a36Sopenharmony_ci
18362306a36Sopenharmony_ci	offset = A1CR_OFFSET + (data->cs - aemif->cs_offset) * 4;
18462306a36Sopenharmony_ci
18562306a36Sopenharmony_ci	ta	= aemif_calc_rate(pdev, data->ta, clk_rate, TA_MAX);
18662306a36Sopenharmony_ci	rhold	= aemif_calc_rate(pdev, data->rhold, clk_rate, RHOLD_MAX);
18762306a36Sopenharmony_ci	rstrobe	= aemif_calc_rate(pdev, data->rstrobe, clk_rate, RSTROBE_MAX);
18862306a36Sopenharmony_ci	rsetup	= aemif_calc_rate(pdev, data->rsetup, clk_rate, RSETUP_MAX);
18962306a36Sopenharmony_ci	whold	= aemif_calc_rate(pdev, data->whold, clk_rate, WHOLD_MAX);
19062306a36Sopenharmony_ci	wstrobe	= aemif_calc_rate(pdev, data->wstrobe, clk_rate, WSTROBE_MAX);
19162306a36Sopenharmony_ci	wsetup	= aemif_calc_rate(pdev, data->wsetup, clk_rate, WSETUP_MAX);
19262306a36Sopenharmony_ci
19362306a36Sopenharmony_ci	if (ta < 0 || rhold < 0 || rstrobe < 0 || rsetup < 0 ||
19462306a36Sopenharmony_ci	    whold < 0 || wstrobe < 0 || wsetup < 0) {
19562306a36Sopenharmony_ci		dev_err(&pdev->dev, "%s: cannot get suitable timings\n",
19662306a36Sopenharmony_ci			__func__);
19762306a36Sopenharmony_ci		return -EINVAL;
19862306a36Sopenharmony_ci	}
19962306a36Sopenharmony_ci
20062306a36Sopenharmony_ci	set = TA(ta) | RHOLD(rhold) | RSTROBE(rstrobe) | RSETUP(rsetup) |
20162306a36Sopenharmony_ci		WHOLD(whold) | WSTROBE(wstrobe) | WSETUP(wsetup);
20262306a36Sopenharmony_ci
20362306a36Sopenharmony_ci	set |= (data->asize & ACR_ASIZE_MASK);
20462306a36Sopenharmony_ci	if (data->enable_ew)
20562306a36Sopenharmony_ci		set |= ACR_EW_MASK;
20662306a36Sopenharmony_ci	if (data->enable_ss)
20762306a36Sopenharmony_ci		set |= ACR_SSTROBE_MASK;
20862306a36Sopenharmony_ci
20962306a36Sopenharmony_ci	val = readl(aemif->base + offset);
21062306a36Sopenharmony_ci	val &= ~CONFIG_MASK;
21162306a36Sopenharmony_ci	val |= set;
21262306a36Sopenharmony_ci	writel(val, aemif->base + offset);
21362306a36Sopenharmony_ci
21462306a36Sopenharmony_ci	return 0;
21562306a36Sopenharmony_ci}
21662306a36Sopenharmony_ci
21762306a36Sopenharmony_cistatic inline int aemif_cycles_to_nsec(int val, unsigned long clk_rate)
21862306a36Sopenharmony_ci{
21962306a36Sopenharmony_ci	return ((val + 1) * NSEC_PER_MSEC) / clk_rate;
22062306a36Sopenharmony_ci}
22162306a36Sopenharmony_ci
22262306a36Sopenharmony_ci/**
22362306a36Sopenharmony_ci * aemif_get_hw_params - function to read hw register values
22462306a36Sopenharmony_ci * @pdev: platform device to read for
22562306a36Sopenharmony_ci * @csnum: aemif chip select number
22662306a36Sopenharmony_ci *
22762306a36Sopenharmony_ci * This function reads the defaults from the registers and update
22862306a36Sopenharmony_ci * the timing values. Required for get/set commands and also for
22962306a36Sopenharmony_ci * the case when driver needs to use defaults in hardware.
23062306a36Sopenharmony_ci */
23162306a36Sopenharmony_cistatic void aemif_get_hw_params(struct platform_device *pdev, int csnum)
23262306a36Sopenharmony_ci{
23362306a36Sopenharmony_ci	struct aemif_device *aemif = platform_get_drvdata(pdev);
23462306a36Sopenharmony_ci	struct aemif_cs_data *data = &aemif->cs_data[csnum];
23562306a36Sopenharmony_ci	unsigned long clk_rate = aemif->clk_rate;
23662306a36Sopenharmony_ci	u32 val, offset;
23762306a36Sopenharmony_ci
23862306a36Sopenharmony_ci	offset = A1CR_OFFSET + (data->cs - aemif->cs_offset) * 4;
23962306a36Sopenharmony_ci	val = readl(aemif->base + offset);
24062306a36Sopenharmony_ci
24162306a36Sopenharmony_ci	data->ta = aemif_cycles_to_nsec(TA_VAL(val), clk_rate);
24262306a36Sopenharmony_ci	data->rhold = aemif_cycles_to_nsec(RHOLD_VAL(val), clk_rate);
24362306a36Sopenharmony_ci	data->rstrobe = aemif_cycles_to_nsec(RSTROBE_VAL(val), clk_rate);
24462306a36Sopenharmony_ci	data->rsetup = aemif_cycles_to_nsec(RSETUP_VAL(val), clk_rate);
24562306a36Sopenharmony_ci	data->whold = aemif_cycles_to_nsec(WHOLD_VAL(val), clk_rate);
24662306a36Sopenharmony_ci	data->wstrobe = aemif_cycles_to_nsec(WSTROBE_VAL(val), clk_rate);
24762306a36Sopenharmony_ci	data->wsetup = aemif_cycles_to_nsec(WSETUP_VAL(val), clk_rate);
24862306a36Sopenharmony_ci	data->enable_ew = EW_VAL(val);
24962306a36Sopenharmony_ci	data->enable_ss = SSTROBE_VAL(val);
25062306a36Sopenharmony_ci	data->asize = val & ASIZE_MAX;
25162306a36Sopenharmony_ci}
25262306a36Sopenharmony_ci
25362306a36Sopenharmony_ci/**
25462306a36Sopenharmony_ci * of_aemif_parse_abus_config - parse CS configuration from DT
25562306a36Sopenharmony_ci * @pdev: platform device to parse for
25662306a36Sopenharmony_ci * @np: device node ptr
25762306a36Sopenharmony_ci *
25862306a36Sopenharmony_ci * This function update the emif async bus configuration based on the values
25962306a36Sopenharmony_ci * configured in a cs device binding node.
26062306a36Sopenharmony_ci */
26162306a36Sopenharmony_cistatic int of_aemif_parse_abus_config(struct platform_device *pdev,
26262306a36Sopenharmony_ci				      struct device_node *np)
26362306a36Sopenharmony_ci{
26462306a36Sopenharmony_ci	struct aemif_device *aemif = platform_get_drvdata(pdev);
26562306a36Sopenharmony_ci	struct aemif_cs_data *data;
26662306a36Sopenharmony_ci	u32 cs;
26762306a36Sopenharmony_ci	u32 val;
26862306a36Sopenharmony_ci
26962306a36Sopenharmony_ci	if (of_property_read_u32(np, "ti,cs-chipselect", &cs)) {
27062306a36Sopenharmony_ci		dev_dbg(&pdev->dev, "cs property is required");
27162306a36Sopenharmony_ci		return -EINVAL;
27262306a36Sopenharmony_ci	}
27362306a36Sopenharmony_ci
27462306a36Sopenharmony_ci	if (cs - aemif->cs_offset >= NUM_CS || cs < aemif->cs_offset) {
27562306a36Sopenharmony_ci		dev_dbg(&pdev->dev, "cs number is incorrect %d", cs);
27662306a36Sopenharmony_ci		return -EINVAL;
27762306a36Sopenharmony_ci	}
27862306a36Sopenharmony_ci
27962306a36Sopenharmony_ci	if (aemif->num_cs >= NUM_CS) {
28062306a36Sopenharmony_ci		dev_dbg(&pdev->dev, "cs count is more than %d", NUM_CS);
28162306a36Sopenharmony_ci		return -EINVAL;
28262306a36Sopenharmony_ci	}
28362306a36Sopenharmony_ci
28462306a36Sopenharmony_ci	data = &aemif->cs_data[aemif->num_cs];
28562306a36Sopenharmony_ci	data->cs = cs;
28662306a36Sopenharmony_ci
28762306a36Sopenharmony_ci	/* read the current value in the hw register */
28862306a36Sopenharmony_ci	aemif_get_hw_params(pdev, aemif->num_cs++);
28962306a36Sopenharmony_ci
29062306a36Sopenharmony_ci	/* override the values from device node */
29162306a36Sopenharmony_ci	if (!of_property_read_u32(np, "ti,cs-min-turnaround-ns", &val))
29262306a36Sopenharmony_ci		data->ta = val;
29362306a36Sopenharmony_ci
29462306a36Sopenharmony_ci	if (!of_property_read_u32(np, "ti,cs-read-hold-ns", &val))
29562306a36Sopenharmony_ci		data->rhold = val;
29662306a36Sopenharmony_ci
29762306a36Sopenharmony_ci	if (!of_property_read_u32(np, "ti,cs-read-strobe-ns", &val))
29862306a36Sopenharmony_ci		data->rstrobe = val;
29962306a36Sopenharmony_ci
30062306a36Sopenharmony_ci	if (!of_property_read_u32(np, "ti,cs-read-setup-ns", &val))
30162306a36Sopenharmony_ci		data->rsetup = val;
30262306a36Sopenharmony_ci
30362306a36Sopenharmony_ci	if (!of_property_read_u32(np, "ti,cs-write-hold-ns", &val))
30462306a36Sopenharmony_ci		data->whold = val;
30562306a36Sopenharmony_ci
30662306a36Sopenharmony_ci	if (!of_property_read_u32(np, "ti,cs-write-strobe-ns", &val))
30762306a36Sopenharmony_ci		data->wstrobe = val;
30862306a36Sopenharmony_ci
30962306a36Sopenharmony_ci	if (!of_property_read_u32(np, "ti,cs-write-setup-ns", &val))
31062306a36Sopenharmony_ci		data->wsetup = val;
31162306a36Sopenharmony_ci
31262306a36Sopenharmony_ci	if (!of_property_read_u32(np, "ti,cs-bus-width", &val))
31362306a36Sopenharmony_ci		if (val == 16)
31462306a36Sopenharmony_ci			data->asize = 1;
31562306a36Sopenharmony_ci	data->enable_ew = of_property_read_bool(np, "ti,cs-extended-wait-mode");
31662306a36Sopenharmony_ci	data->enable_ss = of_property_read_bool(np, "ti,cs-select-strobe-mode");
31762306a36Sopenharmony_ci	return 0;
31862306a36Sopenharmony_ci}
31962306a36Sopenharmony_ci
32062306a36Sopenharmony_cistatic const struct of_device_id aemif_of_match[] = {
32162306a36Sopenharmony_ci	{ .compatible = "ti,davinci-aemif", },
32262306a36Sopenharmony_ci	{ .compatible = "ti,da850-aemif", },
32362306a36Sopenharmony_ci	{},
32462306a36Sopenharmony_ci};
32562306a36Sopenharmony_ciMODULE_DEVICE_TABLE(of, aemif_of_match);
32662306a36Sopenharmony_ci
32762306a36Sopenharmony_cistatic int aemif_probe(struct platform_device *pdev)
32862306a36Sopenharmony_ci{
32962306a36Sopenharmony_ci	int i;
33062306a36Sopenharmony_ci	int ret = -ENODEV;
33162306a36Sopenharmony_ci	struct device *dev = &pdev->dev;
33262306a36Sopenharmony_ci	struct device_node *np = dev->of_node;
33362306a36Sopenharmony_ci	struct device_node *child_np;
33462306a36Sopenharmony_ci	struct aemif_device *aemif;
33562306a36Sopenharmony_ci	struct aemif_platform_data *pdata;
33662306a36Sopenharmony_ci	struct of_dev_auxdata *dev_lookup;
33762306a36Sopenharmony_ci
33862306a36Sopenharmony_ci	aemif = devm_kzalloc(dev, sizeof(*aemif), GFP_KERNEL);
33962306a36Sopenharmony_ci	if (!aemif)
34062306a36Sopenharmony_ci		return -ENOMEM;
34162306a36Sopenharmony_ci
34262306a36Sopenharmony_ci	pdata = dev_get_platdata(&pdev->dev);
34362306a36Sopenharmony_ci	dev_lookup = pdata ? pdata->dev_lookup : NULL;
34462306a36Sopenharmony_ci
34562306a36Sopenharmony_ci	platform_set_drvdata(pdev, aemif);
34662306a36Sopenharmony_ci
34762306a36Sopenharmony_ci	aemif->clk = devm_clk_get(dev, NULL);
34862306a36Sopenharmony_ci	if (IS_ERR(aemif->clk)) {
34962306a36Sopenharmony_ci		dev_err(dev, "cannot get clock 'aemif'\n");
35062306a36Sopenharmony_ci		return PTR_ERR(aemif->clk);
35162306a36Sopenharmony_ci	}
35262306a36Sopenharmony_ci
35362306a36Sopenharmony_ci	ret = clk_prepare_enable(aemif->clk);
35462306a36Sopenharmony_ci	if (ret)
35562306a36Sopenharmony_ci		return ret;
35662306a36Sopenharmony_ci
35762306a36Sopenharmony_ci	aemif->clk_rate = clk_get_rate(aemif->clk) / MSEC_PER_SEC;
35862306a36Sopenharmony_ci
35962306a36Sopenharmony_ci	if (np && of_device_is_compatible(np, "ti,da850-aemif"))
36062306a36Sopenharmony_ci		aemif->cs_offset = 2;
36162306a36Sopenharmony_ci	else if (pdata)
36262306a36Sopenharmony_ci		aemif->cs_offset = pdata->cs_offset;
36362306a36Sopenharmony_ci
36462306a36Sopenharmony_ci	aemif->base = devm_platform_ioremap_resource(pdev, 0);
36562306a36Sopenharmony_ci	if (IS_ERR(aemif->base)) {
36662306a36Sopenharmony_ci		ret = PTR_ERR(aemif->base);
36762306a36Sopenharmony_ci		goto error;
36862306a36Sopenharmony_ci	}
36962306a36Sopenharmony_ci
37062306a36Sopenharmony_ci	if (np) {
37162306a36Sopenharmony_ci		/*
37262306a36Sopenharmony_ci		 * For every controller device node, there is a cs device node
37362306a36Sopenharmony_ci		 * that describe the bus configuration parameters. This
37462306a36Sopenharmony_ci		 * functions iterate over these nodes and update the cs data
37562306a36Sopenharmony_ci		 * array.
37662306a36Sopenharmony_ci		 */
37762306a36Sopenharmony_ci		for_each_available_child_of_node(np, child_np) {
37862306a36Sopenharmony_ci			ret = of_aemif_parse_abus_config(pdev, child_np);
37962306a36Sopenharmony_ci			if (ret < 0) {
38062306a36Sopenharmony_ci				of_node_put(child_np);
38162306a36Sopenharmony_ci				goto error;
38262306a36Sopenharmony_ci			}
38362306a36Sopenharmony_ci		}
38462306a36Sopenharmony_ci	} else if (pdata && pdata->num_abus_data > 0) {
38562306a36Sopenharmony_ci		for (i = 0; i < pdata->num_abus_data; i++, aemif->num_cs++) {
38662306a36Sopenharmony_ci			aemif->cs_data[i].cs = pdata->abus_data[i].cs;
38762306a36Sopenharmony_ci			aemif_get_hw_params(pdev, i);
38862306a36Sopenharmony_ci		}
38962306a36Sopenharmony_ci	}
39062306a36Sopenharmony_ci
39162306a36Sopenharmony_ci	for (i = 0; i < aemif->num_cs; i++) {
39262306a36Sopenharmony_ci		ret = aemif_config_abus(pdev, i);
39362306a36Sopenharmony_ci		if (ret < 0) {
39462306a36Sopenharmony_ci			dev_err(dev, "Error configuring chip select %d\n",
39562306a36Sopenharmony_ci				aemif->cs_data[i].cs);
39662306a36Sopenharmony_ci			goto error;
39762306a36Sopenharmony_ci		}
39862306a36Sopenharmony_ci	}
39962306a36Sopenharmony_ci
40062306a36Sopenharmony_ci	/*
40162306a36Sopenharmony_ci	 * Create a child devices explicitly from here to guarantee that the
40262306a36Sopenharmony_ci	 * child will be probed after the AEMIF timing parameters are set.
40362306a36Sopenharmony_ci	 */
40462306a36Sopenharmony_ci	if (np) {
40562306a36Sopenharmony_ci		for_each_available_child_of_node(np, child_np) {
40662306a36Sopenharmony_ci			ret = of_platform_populate(child_np, NULL,
40762306a36Sopenharmony_ci						   dev_lookup, dev);
40862306a36Sopenharmony_ci			if (ret < 0) {
40962306a36Sopenharmony_ci				of_node_put(child_np);
41062306a36Sopenharmony_ci				goto error;
41162306a36Sopenharmony_ci			}
41262306a36Sopenharmony_ci		}
41362306a36Sopenharmony_ci	} else if (pdata) {
41462306a36Sopenharmony_ci		for (i = 0; i < pdata->num_sub_devices; i++) {
41562306a36Sopenharmony_ci			pdata->sub_devices[i].dev.parent = dev;
41662306a36Sopenharmony_ci			ret = platform_device_register(&pdata->sub_devices[i]);
41762306a36Sopenharmony_ci			if (ret) {
41862306a36Sopenharmony_ci				dev_warn(dev, "Error register sub device %s\n",
41962306a36Sopenharmony_ci					 pdata->sub_devices[i].name);
42062306a36Sopenharmony_ci			}
42162306a36Sopenharmony_ci		}
42262306a36Sopenharmony_ci	}
42362306a36Sopenharmony_ci
42462306a36Sopenharmony_ci	return 0;
42562306a36Sopenharmony_cierror:
42662306a36Sopenharmony_ci	clk_disable_unprepare(aemif->clk);
42762306a36Sopenharmony_ci	return ret;
42862306a36Sopenharmony_ci}
42962306a36Sopenharmony_ci
43062306a36Sopenharmony_cistatic int aemif_remove(struct platform_device *pdev)
43162306a36Sopenharmony_ci{
43262306a36Sopenharmony_ci	struct aemif_device *aemif = platform_get_drvdata(pdev);
43362306a36Sopenharmony_ci
43462306a36Sopenharmony_ci	clk_disable_unprepare(aemif->clk);
43562306a36Sopenharmony_ci	return 0;
43662306a36Sopenharmony_ci}
43762306a36Sopenharmony_ci
43862306a36Sopenharmony_cistatic struct platform_driver aemif_driver = {
43962306a36Sopenharmony_ci	.probe = aemif_probe,
44062306a36Sopenharmony_ci	.remove = aemif_remove,
44162306a36Sopenharmony_ci	.driver = {
44262306a36Sopenharmony_ci		.name = "ti-aemif",
44362306a36Sopenharmony_ci		.of_match_table = of_match_ptr(aemif_of_match),
44462306a36Sopenharmony_ci	},
44562306a36Sopenharmony_ci};
44662306a36Sopenharmony_ci
44762306a36Sopenharmony_cimodule_platform_driver(aemif_driver);
44862306a36Sopenharmony_ci
44962306a36Sopenharmony_ciMODULE_AUTHOR("Murali Karicheri <m-karicheri2@ti.com>");
45062306a36Sopenharmony_ciMODULE_AUTHOR("Ivan Khoronzhuk <ivan.khoronzhuk@ti.com>");
45162306a36Sopenharmony_ciMODULE_DESCRIPTION("Texas Instruments AEMIF driver");
45262306a36Sopenharmony_ciMODULE_LICENSE("GPL v2");
45362306a36Sopenharmony_ciMODULE_ALIAS("platform:" KBUILD_MODNAME);
454