1*4882a593Smuzhiyun // SPDX-License-Identifier: GPL-2.0-only
2*4882a593Smuzhiyun /*
3*4882a593Smuzhiyun * TI AEMIF driver
4*4882a593Smuzhiyun *
5*4882a593Smuzhiyun * Copyright (C) 2010 - 2013 Texas Instruments Incorporated. http://www.ti.com/
6*4882a593Smuzhiyun *
7*4882a593Smuzhiyun * Authors:
8*4882a593Smuzhiyun * Murali Karicheri <m-karicheri2@ti.com>
9*4882a593Smuzhiyun * Ivan Khoronzhuk <ivan.khoronzhuk@ti.com>
10*4882a593Smuzhiyun */
11*4882a593Smuzhiyun
12*4882a593Smuzhiyun #include <linux/clk.h>
13*4882a593Smuzhiyun #include <linux/err.h>
14*4882a593Smuzhiyun #include <linux/io.h>
15*4882a593Smuzhiyun #include <linux/kernel.h>
16*4882a593Smuzhiyun #include <linux/module.h>
17*4882a593Smuzhiyun #include <linux/of.h>
18*4882a593Smuzhiyun #include <linux/of_platform.h>
19*4882a593Smuzhiyun #include <linux/platform_device.h>
20*4882a593Smuzhiyun #include <linux/platform_data/ti-aemif.h>
21*4882a593Smuzhiyun
22*4882a593Smuzhiyun #define TA_SHIFT 2
23*4882a593Smuzhiyun #define RHOLD_SHIFT 4
24*4882a593Smuzhiyun #define RSTROBE_SHIFT 7
25*4882a593Smuzhiyun #define RSETUP_SHIFT 13
26*4882a593Smuzhiyun #define WHOLD_SHIFT 17
27*4882a593Smuzhiyun #define WSTROBE_SHIFT 20
28*4882a593Smuzhiyun #define WSETUP_SHIFT 26
29*4882a593Smuzhiyun #define EW_SHIFT 30
30*4882a593Smuzhiyun #define SSTROBE_SHIFT 31
31*4882a593Smuzhiyun
32*4882a593Smuzhiyun #define TA(x) ((x) << TA_SHIFT)
33*4882a593Smuzhiyun #define RHOLD(x) ((x) << RHOLD_SHIFT)
34*4882a593Smuzhiyun #define RSTROBE(x) ((x) << RSTROBE_SHIFT)
35*4882a593Smuzhiyun #define RSETUP(x) ((x) << RSETUP_SHIFT)
36*4882a593Smuzhiyun #define WHOLD(x) ((x) << WHOLD_SHIFT)
37*4882a593Smuzhiyun #define WSTROBE(x) ((x) << WSTROBE_SHIFT)
38*4882a593Smuzhiyun #define WSETUP(x) ((x) << WSETUP_SHIFT)
39*4882a593Smuzhiyun #define EW(x) ((x) << EW_SHIFT)
40*4882a593Smuzhiyun #define SSTROBE(x) ((x) << SSTROBE_SHIFT)
41*4882a593Smuzhiyun
42*4882a593Smuzhiyun #define ASIZE_MAX 0x1
43*4882a593Smuzhiyun #define TA_MAX 0x3
44*4882a593Smuzhiyun #define RHOLD_MAX 0x7
45*4882a593Smuzhiyun #define RSTROBE_MAX 0x3f
46*4882a593Smuzhiyun #define RSETUP_MAX 0xf
47*4882a593Smuzhiyun #define WHOLD_MAX 0x7
48*4882a593Smuzhiyun #define WSTROBE_MAX 0x3f
49*4882a593Smuzhiyun #define WSETUP_MAX 0xf
50*4882a593Smuzhiyun #define EW_MAX 0x1
51*4882a593Smuzhiyun #define SSTROBE_MAX 0x1
52*4882a593Smuzhiyun #define NUM_CS 4
53*4882a593Smuzhiyun
54*4882a593Smuzhiyun #define TA_VAL(x) (((x) & TA(TA_MAX)) >> TA_SHIFT)
55*4882a593Smuzhiyun #define RHOLD_VAL(x) (((x) & RHOLD(RHOLD_MAX)) >> RHOLD_SHIFT)
56*4882a593Smuzhiyun #define RSTROBE_VAL(x) (((x) & RSTROBE(RSTROBE_MAX)) >> RSTROBE_SHIFT)
57*4882a593Smuzhiyun #define RSETUP_VAL(x) (((x) & RSETUP(RSETUP_MAX)) >> RSETUP_SHIFT)
58*4882a593Smuzhiyun #define WHOLD_VAL(x) (((x) & WHOLD(WHOLD_MAX)) >> WHOLD_SHIFT)
59*4882a593Smuzhiyun #define WSTROBE_VAL(x) (((x) & WSTROBE(WSTROBE_MAX)) >> WSTROBE_SHIFT)
60*4882a593Smuzhiyun #define WSETUP_VAL(x) (((x) & WSETUP(WSETUP_MAX)) >> WSETUP_SHIFT)
61*4882a593Smuzhiyun #define EW_VAL(x) (((x) & EW(EW_MAX)) >> EW_SHIFT)
62*4882a593Smuzhiyun #define SSTROBE_VAL(x) (((x) & SSTROBE(SSTROBE_MAX)) >> SSTROBE_SHIFT)
63*4882a593Smuzhiyun
64*4882a593Smuzhiyun #define NRCSR_OFFSET 0x00
65*4882a593Smuzhiyun #define AWCCR_OFFSET 0x04
66*4882a593Smuzhiyun #define A1CR_OFFSET 0x10
67*4882a593Smuzhiyun
68*4882a593Smuzhiyun #define ACR_ASIZE_MASK 0x3
69*4882a593Smuzhiyun #define ACR_EW_MASK BIT(30)
70*4882a593Smuzhiyun #define ACR_SSTROBE_MASK BIT(31)
71*4882a593Smuzhiyun #define ASIZE_16BIT 1
72*4882a593Smuzhiyun
73*4882a593Smuzhiyun #define CONFIG_MASK (TA(TA_MAX) | \
74*4882a593Smuzhiyun RHOLD(RHOLD_MAX) | \
75*4882a593Smuzhiyun RSTROBE(RSTROBE_MAX) | \
76*4882a593Smuzhiyun RSETUP(RSETUP_MAX) | \
77*4882a593Smuzhiyun WHOLD(WHOLD_MAX) | \
78*4882a593Smuzhiyun WSTROBE(WSTROBE_MAX) | \
79*4882a593Smuzhiyun WSETUP(WSETUP_MAX) | \
80*4882a593Smuzhiyun EW(EW_MAX) | SSTROBE(SSTROBE_MAX) | \
81*4882a593Smuzhiyun ASIZE_MAX)
82*4882a593Smuzhiyun
83*4882a593Smuzhiyun /**
84*4882a593Smuzhiyun * struct aemif_cs_data: structure to hold cs parameters
85*4882a593Smuzhiyun * @cs: chip-select number
86*4882a593Smuzhiyun * @wstrobe: write strobe width, ns
87*4882a593Smuzhiyun * @rstrobe: read strobe width, ns
88*4882a593Smuzhiyun * @wsetup: write setup width, ns
89*4882a593Smuzhiyun * @whold: write hold width, ns
90*4882a593Smuzhiyun * @rsetup: read setup width, ns
91*4882a593Smuzhiyun * @rhold: read hold width, ns
92*4882a593Smuzhiyun * @ta: minimum turn around time, ns
93*4882a593Smuzhiyun * @enable_ss: enable/disable select strobe mode
94*4882a593Smuzhiyun * @enable_ew: enable/disable extended wait mode
95*4882a593Smuzhiyun * @asize: width of the asynchronous device's data bus
96*4882a593Smuzhiyun */
97*4882a593Smuzhiyun struct aemif_cs_data {
98*4882a593Smuzhiyun u8 cs;
99*4882a593Smuzhiyun u16 wstrobe;
100*4882a593Smuzhiyun u16 rstrobe;
101*4882a593Smuzhiyun u8 wsetup;
102*4882a593Smuzhiyun u8 whold;
103*4882a593Smuzhiyun u8 rsetup;
104*4882a593Smuzhiyun u8 rhold;
105*4882a593Smuzhiyun u8 ta;
106*4882a593Smuzhiyun u8 enable_ss;
107*4882a593Smuzhiyun u8 enable_ew;
108*4882a593Smuzhiyun u8 asize;
109*4882a593Smuzhiyun };
110*4882a593Smuzhiyun
111*4882a593Smuzhiyun /**
112*4882a593Smuzhiyun * struct aemif_device: structure to hold device data
113*4882a593Smuzhiyun * @base: base address of AEMIF registers
114*4882a593Smuzhiyun * @clk: source clock
115*4882a593Smuzhiyun * @clk_rate: clock's rate in kHz
116*4882a593Smuzhiyun * @num_cs: number of assigned chip-selects
117*4882a593Smuzhiyun * @cs_offset: start number of cs nodes
118*4882a593Smuzhiyun * @cs_data: array of chip-select settings
119*4882a593Smuzhiyun */
120*4882a593Smuzhiyun struct aemif_device {
121*4882a593Smuzhiyun void __iomem *base;
122*4882a593Smuzhiyun struct clk *clk;
123*4882a593Smuzhiyun unsigned long clk_rate;
124*4882a593Smuzhiyun u8 num_cs;
125*4882a593Smuzhiyun int cs_offset;
126*4882a593Smuzhiyun struct aemif_cs_data cs_data[NUM_CS];
127*4882a593Smuzhiyun };
128*4882a593Smuzhiyun
129*4882a593Smuzhiyun /**
130*4882a593Smuzhiyun * aemif_calc_rate - calculate timing data.
131*4882a593Smuzhiyun * @pdev: platform device to calculate for
132*4882a593Smuzhiyun * @wanted: The cycle time needed in nanoseconds.
133*4882a593Smuzhiyun * @clk: The input clock rate in kHz.
134*4882a593Smuzhiyun * @max: The maximum divider value that can be programmed.
135*4882a593Smuzhiyun *
136*4882a593Smuzhiyun * On success, returns the calculated timing value minus 1 for easy
137*4882a593Smuzhiyun * programming into AEMIF timing registers, else negative errno.
138*4882a593Smuzhiyun */
aemif_calc_rate(struct platform_device * pdev,int wanted,unsigned long clk,int max)139*4882a593Smuzhiyun static int aemif_calc_rate(struct platform_device *pdev, int wanted,
140*4882a593Smuzhiyun unsigned long clk, int max)
141*4882a593Smuzhiyun {
142*4882a593Smuzhiyun int result;
143*4882a593Smuzhiyun
144*4882a593Smuzhiyun result = DIV_ROUND_UP((wanted * clk), NSEC_PER_MSEC) - 1;
145*4882a593Smuzhiyun
146*4882a593Smuzhiyun dev_dbg(&pdev->dev, "%s: result %d from %ld, %d\n", __func__, result,
147*4882a593Smuzhiyun clk, wanted);
148*4882a593Smuzhiyun
149*4882a593Smuzhiyun /* It is generally OK to have a more relaxed timing than requested... */
150*4882a593Smuzhiyun if (result < 0)
151*4882a593Smuzhiyun result = 0;
152*4882a593Smuzhiyun
153*4882a593Smuzhiyun /* ... But configuring tighter timings is not an option. */
154*4882a593Smuzhiyun else if (result > max)
155*4882a593Smuzhiyun result = -EINVAL;
156*4882a593Smuzhiyun
157*4882a593Smuzhiyun return result;
158*4882a593Smuzhiyun }
159*4882a593Smuzhiyun
160*4882a593Smuzhiyun /**
161*4882a593Smuzhiyun * aemif_config_abus - configure async bus parameters
162*4882a593Smuzhiyun * @pdev: platform device to configure for
163*4882a593Smuzhiyun * @csnum: aemif chip select number
164*4882a593Smuzhiyun *
165*4882a593Smuzhiyun * This function programs the given timing values (in real clock) into the
166*4882a593Smuzhiyun * AEMIF registers taking the AEMIF clock into account.
167*4882a593Smuzhiyun *
168*4882a593Smuzhiyun * This function does not use any locking while programming the AEMIF
169*4882a593Smuzhiyun * because it is expected that there is only one user of a given
170*4882a593Smuzhiyun * chip-select.
171*4882a593Smuzhiyun *
172*4882a593Smuzhiyun * Returns 0 on success, else negative errno.
173*4882a593Smuzhiyun */
aemif_config_abus(struct platform_device * pdev,int csnum)174*4882a593Smuzhiyun static int aemif_config_abus(struct platform_device *pdev, int csnum)
175*4882a593Smuzhiyun {
176*4882a593Smuzhiyun struct aemif_device *aemif = platform_get_drvdata(pdev);
177*4882a593Smuzhiyun struct aemif_cs_data *data = &aemif->cs_data[csnum];
178*4882a593Smuzhiyun int ta, rhold, rstrobe, rsetup, whold, wstrobe, wsetup;
179*4882a593Smuzhiyun unsigned long clk_rate = aemif->clk_rate;
180*4882a593Smuzhiyun unsigned offset;
181*4882a593Smuzhiyun u32 set, val;
182*4882a593Smuzhiyun
183*4882a593Smuzhiyun offset = A1CR_OFFSET + (data->cs - aemif->cs_offset) * 4;
184*4882a593Smuzhiyun
185*4882a593Smuzhiyun ta = aemif_calc_rate(pdev, data->ta, clk_rate, TA_MAX);
186*4882a593Smuzhiyun rhold = aemif_calc_rate(pdev, data->rhold, clk_rate, RHOLD_MAX);
187*4882a593Smuzhiyun rstrobe = aemif_calc_rate(pdev, data->rstrobe, clk_rate, RSTROBE_MAX);
188*4882a593Smuzhiyun rsetup = aemif_calc_rate(pdev, data->rsetup, clk_rate, RSETUP_MAX);
189*4882a593Smuzhiyun whold = aemif_calc_rate(pdev, data->whold, clk_rate, WHOLD_MAX);
190*4882a593Smuzhiyun wstrobe = aemif_calc_rate(pdev, data->wstrobe, clk_rate, WSTROBE_MAX);
191*4882a593Smuzhiyun wsetup = aemif_calc_rate(pdev, data->wsetup, clk_rate, WSETUP_MAX);
192*4882a593Smuzhiyun
193*4882a593Smuzhiyun if (ta < 0 || rhold < 0 || rstrobe < 0 || rsetup < 0 ||
194*4882a593Smuzhiyun whold < 0 || wstrobe < 0 || wsetup < 0) {
195*4882a593Smuzhiyun dev_err(&pdev->dev, "%s: cannot get suitable timings\n",
196*4882a593Smuzhiyun __func__);
197*4882a593Smuzhiyun return -EINVAL;
198*4882a593Smuzhiyun }
199*4882a593Smuzhiyun
200*4882a593Smuzhiyun set = TA(ta) | RHOLD(rhold) | RSTROBE(rstrobe) | RSETUP(rsetup) |
201*4882a593Smuzhiyun WHOLD(whold) | WSTROBE(wstrobe) | WSETUP(wsetup);
202*4882a593Smuzhiyun
203*4882a593Smuzhiyun set |= (data->asize & ACR_ASIZE_MASK);
204*4882a593Smuzhiyun if (data->enable_ew)
205*4882a593Smuzhiyun set |= ACR_EW_MASK;
206*4882a593Smuzhiyun if (data->enable_ss)
207*4882a593Smuzhiyun set |= ACR_SSTROBE_MASK;
208*4882a593Smuzhiyun
209*4882a593Smuzhiyun val = readl(aemif->base + offset);
210*4882a593Smuzhiyun val &= ~CONFIG_MASK;
211*4882a593Smuzhiyun val |= set;
212*4882a593Smuzhiyun writel(val, aemif->base + offset);
213*4882a593Smuzhiyun
214*4882a593Smuzhiyun return 0;
215*4882a593Smuzhiyun }
216*4882a593Smuzhiyun
aemif_cycles_to_nsec(int val,unsigned long clk_rate)217*4882a593Smuzhiyun static inline int aemif_cycles_to_nsec(int val, unsigned long clk_rate)
218*4882a593Smuzhiyun {
219*4882a593Smuzhiyun return ((val + 1) * NSEC_PER_MSEC) / clk_rate;
220*4882a593Smuzhiyun }
221*4882a593Smuzhiyun
222*4882a593Smuzhiyun /**
223*4882a593Smuzhiyun * aemif_get_hw_params - function to read hw register values
224*4882a593Smuzhiyun * @pdev: platform device to read for
225*4882a593Smuzhiyun * @csnum: aemif chip select number
226*4882a593Smuzhiyun *
227*4882a593Smuzhiyun * This function reads the defaults from the registers and update
228*4882a593Smuzhiyun * the timing values. Required for get/set commands and also for
229*4882a593Smuzhiyun * the case when driver needs to use defaults in hardware.
230*4882a593Smuzhiyun */
aemif_get_hw_params(struct platform_device * pdev,int csnum)231*4882a593Smuzhiyun static void aemif_get_hw_params(struct platform_device *pdev, int csnum)
232*4882a593Smuzhiyun {
233*4882a593Smuzhiyun struct aemif_device *aemif = platform_get_drvdata(pdev);
234*4882a593Smuzhiyun struct aemif_cs_data *data = &aemif->cs_data[csnum];
235*4882a593Smuzhiyun unsigned long clk_rate = aemif->clk_rate;
236*4882a593Smuzhiyun u32 val, offset;
237*4882a593Smuzhiyun
238*4882a593Smuzhiyun offset = A1CR_OFFSET + (data->cs - aemif->cs_offset) * 4;
239*4882a593Smuzhiyun val = readl(aemif->base + offset);
240*4882a593Smuzhiyun
241*4882a593Smuzhiyun data->ta = aemif_cycles_to_nsec(TA_VAL(val), clk_rate);
242*4882a593Smuzhiyun data->rhold = aemif_cycles_to_nsec(RHOLD_VAL(val), clk_rate);
243*4882a593Smuzhiyun data->rstrobe = aemif_cycles_to_nsec(RSTROBE_VAL(val), clk_rate);
244*4882a593Smuzhiyun data->rsetup = aemif_cycles_to_nsec(RSETUP_VAL(val), clk_rate);
245*4882a593Smuzhiyun data->whold = aemif_cycles_to_nsec(WHOLD_VAL(val), clk_rate);
246*4882a593Smuzhiyun data->wstrobe = aemif_cycles_to_nsec(WSTROBE_VAL(val), clk_rate);
247*4882a593Smuzhiyun data->wsetup = aemif_cycles_to_nsec(WSETUP_VAL(val), clk_rate);
248*4882a593Smuzhiyun data->enable_ew = EW_VAL(val);
249*4882a593Smuzhiyun data->enable_ss = SSTROBE_VAL(val);
250*4882a593Smuzhiyun data->asize = val & ASIZE_MAX;
251*4882a593Smuzhiyun }
252*4882a593Smuzhiyun
253*4882a593Smuzhiyun /**
254*4882a593Smuzhiyun * of_aemif_parse_abus_config - parse CS configuration from DT
255*4882a593Smuzhiyun * @pdev: platform device to parse for
256*4882a593Smuzhiyun * @np: device node ptr
257*4882a593Smuzhiyun *
258*4882a593Smuzhiyun * This function update the emif async bus configuration based on the values
259*4882a593Smuzhiyun * configured in a cs device binding node.
260*4882a593Smuzhiyun */
of_aemif_parse_abus_config(struct platform_device * pdev,struct device_node * np)261*4882a593Smuzhiyun static int of_aemif_parse_abus_config(struct platform_device *pdev,
262*4882a593Smuzhiyun struct device_node *np)
263*4882a593Smuzhiyun {
264*4882a593Smuzhiyun struct aemif_device *aemif = platform_get_drvdata(pdev);
265*4882a593Smuzhiyun struct aemif_cs_data *data;
266*4882a593Smuzhiyun u32 cs;
267*4882a593Smuzhiyun u32 val;
268*4882a593Smuzhiyun
269*4882a593Smuzhiyun if (of_property_read_u32(np, "ti,cs-chipselect", &cs)) {
270*4882a593Smuzhiyun dev_dbg(&pdev->dev, "cs property is required");
271*4882a593Smuzhiyun return -EINVAL;
272*4882a593Smuzhiyun }
273*4882a593Smuzhiyun
274*4882a593Smuzhiyun if (cs - aemif->cs_offset >= NUM_CS || cs < aemif->cs_offset) {
275*4882a593Smuzhiyun dev_dbg(&pdev->dev, "cs number is incorrect %d", cs);
276*4882a593Smuzhiyun return -EINVAL;
277*4882a593Smuzhiyun }
278*4882a593Smuzhiyun
279*4882a593Smuzhiyun if (aemif->num_cs >= NUM_CS) {
280*4882a593Smuzhiyun dev_dbg(&pdev->dev, "cs count is more than %d", NUM_CS);
281*4882a593Smuzhiyun return -EINVAL;
282*4882a593Smuzhiyun }
283*4882a593Smuzhiyun
284*4882a593Smuzhiyun data = &aemif->cs_data[aemif->num_cs];
285*4882a593Smuzhiyun data->cs = cs;
286*4882a593Smuzhiyun
287*4882a593Smuzhiyun /* read the current value in the hw register */
288*4882a593Smuzhiyun aemif_get_hw_params(pdev, aemif->num_cs++);
289*4882a593Smuzhiyun
290*4882a593Smuzhiyun /* override the values from device node */
291*4882a593Smuzhiyun if (!of_property_read_u32(np, "ti,cs-min-turnaround-ns", &val))
292*4882a593Smuzhiyun data->ta = val;
293*4882a593Smuzhiyun
294*4882a593Smuzhiyun if (!of_property_read_u32(np, "ti,cs-read-hold-ns", &val))
295*4882a593Smuzhiyun data->rhold = val;
296*4882a593Smuzhiyun
297*4882a593Smuzhiyun if (!of_property_read_u32(np, "ti,cs-read-strobe-ns", &val))
298*4882a593Smuzhiyun data->rstrobe = val;
299*4882a593Smuzhiyun
300*4882a593Smuzhiyun if (!of_property_read_u32(np, "ti,cs-read-setup-ns", &val))
301*4882a593Smuzhiyun data->rsetup = val;
302*4882a593Smuzhiyun
303*4882a593Smuzhiyun if (!of_property_read_u32(np, "ti,cs-write-hold-ns", &val))
304*4882a593Smuzhiyun data->whold = val;
305*4882a593Smuzhiyun
306*4882a593Smuzhiyun if (!of_property_read_u32(np, "ti,cs-write-strobe-ns", &val))
307*4882a593Smuzhiyun data->wstrobe = val;
308*4882a593Smuzhiyun
309*4882a593Smuzhiyun if (!of_property_read_u32(np, "ti,cs-write-setup-ns", &val))
310*4882a593Smuzhiyun data->wsetup = val;
311*4882a593Smuzhiyun
312*4882a593Smuzhiyun if (!of_property_read_u32(np, "ti,cs-bus-width", &val))
313*4882a593Smuzhiyun if (val == 16)
314*4882a593Smuzhiyun data->asize = 1;
315*4882a593Smuzhiyun data->enable_ew = of_property_read_bool(np, "ti,cs-extended-wait-mode");
316*4882a593Smuzhiyun data->enable_ss = of_property_read_bool(np, "ti,cs-select-strobe-mode");
317*4882a593Smuzhiyun return 0;
318*4882a593Smuzhiyun }
319*4882a593Smuzhiyun
320*4882a593Smuzhiyun static const struct of_device_id aemif_of_match[] = {
321*4882a593Smuzhiyun { .compatible = "ti,davinci-aemif", },
322*4882a593Smuzhiyun { .compatible = "ti,da850-aemif", },
323*4882a593Smuzhiyun {},
324*4882a593Smuzhiyun };
325*4882a593Smuzhiyun MODULE_DEVICE_TABLE(of, aemif_of_match);
326*4882a593Smuzhiyun
aemif_probe(struct platform_device * pdev)327*4882a593Smuzhiyun static int aemif_probe(struct platform_device *pdev)
328*4882a593Smuzhiyun {
329*4882a593Smuzhiyun int i;
330*4882a593Smuzhiyun int ret = -ENODEV;
331*4882a593Smuzhiyun struct resource *res;
332*4882a593Smuzhiyun struct device *dev = &pdev->dev;
333*4882a593Smuzhiyun struct device_node *np = dev->of_node;
334*4882a593Smuzhiyun struct device_node *child_np;
335*4882a593Smuzhiyun struct aemif_device *aemif;
336*4882a593Smuzhiyun struct aemif_platform_data *pdata;
337*4882a593Smuzhiyun struct of_dev_auxdata *dev_lookup;
338*4882a593Smuzhiyun
339*4882a593Smuzhiyun aemif = devm_kzalloc(dev, sizeof(*aemif), GFP_KERNEL);
340*4882a593Smuzhiyun if (!aemif)
341*4882a593Smuzhiyun return -ENOMEM;
342*4882a593Smuzhiyun
343*4882a593Smuzhiyun pdata = dev_get_platdata(&pdev->dev);
344*4882a593Smuzhiyun dev_lookup = pdata ? pdata->dev_lookup : NULL;
345*4882a593Smuzhiyun
346*4882a593Smuzhiyun platform_set_drvdata(pdev, aemif);
347*4882a593Smuzhiyun
348*4882a593Smuzhiyun aemif->clk = devm_clk_get(dev, NULL);
349*4882a593Smuzhiyun if (IS_ERR(aemif->clk)) {
350*4882a593Smuzhiyun dev_err(dev, "cannot get clock 'aemif'\n");
351*4882a593Smuzhiyun return PTR_ERR(aemif->clk);
352*4882a593Smuzhiyun }
353*4882a593Smuzhiyun
354*4882a593Smuzhiyun ret = clk_prepare_enable(aemif->clk);
355*4882a593Smuzhiyun if (ret)
356*4882a593Smuzhiyun return ret;
357*4882a593Smuzhiyun
358*4882a593Smuzhiyun aemif->clk_rate = clk_get_rate(aemif->clk) / MSEC_PER_SEC;
359*4882a593Smuzhiyun
360*4882a593Smuzhiyun if (np && of_device_is_compatible(np, "ti,da850-aemif"))
361*4882a593Smuzhiyun aemif->cs_offset = 2;
362*4882a593Smuzhiyun else if (pdata)
363*4882a593Smuzhiyun aemif->cs_offset = pdata->cs_offset;
364*4882a593Smuzhiyun
365*4882a593Smuzhiyun res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
366*4882a593Smuzhiyun aemif->base = devm_ioremap_resource(dev, res);
367*4882a593Smuzhiyun if (IS_ERR(aemif->base)) {
368*4882a593Smuzhiyun ret = PTR_ERR(aemif->base);
369*4882a593Smuzhiyun goto error;
370*4882a593Smuzhiyun }
371*4882a593Smuzhiyun
372*4882a593Smuzhiyun if (np) {
373*4882a593Smuzhiyun /*
374*4882a593Smuzhiyun * For every controller device node, there is a cs device node
375*4882a593Smuzhiyun * that describe the bus configuration parameters. This
376*4882a593Smuzhiyun * functions iterate over these nodes and update the cs data
377*4882a593Smuzhiyun * array.
378*4882a593Smuzhiyun */
379*4882a593Smuzhiyun for_each_available_child_of_node(np, child_np) {
380*4882a593Smuzhiyun ret = of_aemif_parse_abus_config(pdev, child_np);
381*4882a593Smuzhiyun if (ret < 0) {
382*4882a593Smuzhiyun of_node_put(child_np);
383*4882a593Smuzhiyun goto error;
384*4882a593Smuzhiyun }
385*4882a593Smuzhiyun }
386*4882a593Smuzhiyun } else if (pdata && pdata->num_abus_data > 0) {
387*4882a593Smuzhiyun for (i = 0; i < pdata->num_abus_data; i++, aemif->num_cs++) {
388*4882a593Smuzhiyun aemif->cs_data[i].cs = pdata->abus_data[i].cs;
389*4882a593Smuzhiyun aemif_get_hw_params(pdev, i);
390*4882a593Smuzhiyun }
391*4882a593Smuzhiyun }
392*4882a593Smuzhiyun
393*4882a593Smuzhiyun for (i = 0; i < aemif->num_cs; i++) {
394*4882a593Smuzhiyun ret = aemif_config_abus(pdev, i);
395*4882a593Smuzhiyun if (ret < 0) {
396*4882a593Smuzhiyun dev_err(dev, "Error configuring chip select %d\n",
397*4882a593Smuzhiyun aemif->cs_data[i].cs);
398*4882a593Smuzhiyun goto error;
399*4882a593Smuzhiyun }
400*4882a593Smuzhiyun }
401*4882a593Smuzhiyun
402*4882a593Smuzhiyun /*
403*4882a593Smuzhiyun * Create a child devices explicitly from here to guarantee that the
404*4882a593Smuzhiyun * child will be probed after the AEMIF timing parameters are set.
405*4882a593Smuzhiyun */
406*4882a593Smuzhiyun if (np) {
407*4882a593Smuzhiyun for_each_available_child_of_node(np, child_np) {
408*4882a593Smuzhiyun ret = of_platform_populate(child_np, NULL,
409*4882a593Smuzhiyun dev_lookup, dev);
410*4882a593Smuzhiyun if (ret < 0) {
411*4882a593Smuzhiyun of_node_put(child_np);
412*4882a593Smuzhiyun goto error;
413*4882a593Smuzhiyun }
414*4882a593Smuzhiyun }
415*4882a593Smuzhiyun } else if (pdata) {
416*4882a593Smuzhiyun for (i = 0; i < pdata->num_sub_devices; i++) {
417*4882a593Smuzhiyun pdata->sub_devices[i].dev.parent = dev;
418*4882a593Smuzhiyun ret = platform_device_register(&pdata->sub_devices[i]);
419*4882a593Smuzhiyun if (ret) {
420*4882a593Smuzhiyun dev_warn(dev, "Error register sub device %s\n",
421*4882a593Smuzhiyun pdata->sub_devices[i].name);
422*4882a593Smuzhiyun }
423*4882a593Smuzhiyun }
424*4882a593Smuzhiyun }
425*4882a593Smuzhiyun
426*4882a593Smuzhiyun return 0;
427*4882a593Smuzhiyun error:
428*4882a593Smuzhiyun clk_disable_unprepare(aemif->clk);
429*4882a593Smuzhiyun return ret;
430*4882a593Smuzhiyun }
431*4882a593Smuzhiyun
aemif_remove(struct platform_device * pdev)432*4882a593Smuzhiyun static int aemif_remove(struct platform_device *pdev)
433*4882a593Smuzhiyun {
434*4882a593Smuzhiyun struct aemif_device *aemif = platform_get_drvdata(pdev);
435*4882a593Smuzhiyun
436*4882a593Smuzhiyun clk_disable_unprepare(aemif->clk);
437*4882a593Smuzhiyun return 0;
438*4882a593Smuzhiyun }
439*4882a593Smuzhiyun
440*4882a593Smuzhiyun static struct platform_driver aemif_driver = {
441*4882a593Smuzhiyun .probe = aemif_probe,
442*4882a593Smuzhiyun .remove = aemif_remove,
443*4882a593Smuzhiyun .driver = {
444*4882a593Smuzhiyun .name = "ti-aemif",
445*4882a593Smuzhiyun .of_match_table = of_match_ptr(aemif_of_match),
446*4882a593Smuzhiyun },
447*4882a593Smuzhiyun };
448*4882a593Smuzhiyun
449*4882a593Smuzhiyun module_platform_driver(aemif_driver);
450*4882a593Smuzhiyun
451*4882a593Smuzhiyun MODULE_AUTHOR("Murali Karicheri <m-karicheri2@ti.com>");
452*4882a593Smuzhiyun MODULE_AUTHOR("Ivan Khoronzhuk <ivan.khoronzhuk@ti.com>");
453*4882a593Smuzhiyun MODULE_DESCRIPTION("Texas Instruments AEMIF driver");
454*4882a593Smuzhiyun MODULE_LICENSE("GPL v2");
455*4882a593Smuzhiyun MODULE_ALIAS("platform:" KBUILD_MODNAME);
456