1*4882a593Smuzhiyun // SPDX-License-Identifier: GPL-2.0-only
2*4882a593Smuzhiyun /*
3*4882a593Smuzhiyun * JZ4780 NAND/external memory controller (NEMC)
4*4882a593Smuzhiyun *
5*4882a593Smuzhiyun * Copyright (c) 2015 Imagination Technologies
6*4882a593Smuzhiyun * Author: Alex Smith <alex@alex-smith.me.uk>
7*4882a593Smuzhiyun */
8*4882a593Smuzhiyun
9*4882a593Smuzhiyun #include <linux/clk.h>
10*4882a593Smuzhiyun #include <linux/init.h>
11*4882a593Smuzhiyun #include <linux/io.h>
12*4882a593Smuzhiyun #include <linux/math64.h>
13*4882a593Smuzhiyun #include <linux/of.h>
14*4882a593Smuzhiyun #include <linux/of_address.h>
15*4882a593Smuzhiyun #include <linux/of_device.h>
16*4882a593Smuzhiyun #include <linux/of_platform.h>
17*4882a593Smuzhiyun #include <linux/platform_device.h>
18*4882a593Smuzhiyun #include <linux/slab.h>
19*4882a593Smuzhiyun #include <linux/spinlock.h>
20*4882a593Smuzhiyun
21*4882a593Smuzhiyun #include <linux/jz4780-nemc.h>
22*4882a593Smuzhiyun
23*4882a593Smuzhiyun #define NEMC_SMCRn(n) (0x14 + (((n) - 1) * 4))
24*4882a593Smuzhiyun #define NEMC_NFCSR 0x50
25*4882a593Smuzhiyun
26*4882a593Smuzhiyun #define NEMC_REG_LEN 0x54
27*4882a593Smuzhiyun
28*4882a593Smuzhiyun #define NEMC_SMCR_SMT BIT(0)
29*4882a593Smuzhiyun #define NEMC_SMCR_BW_SHIFT 6
30*4882a593Smuzhiyun #define NEMC_SMCR_BW_MASK (0x3 << NEMC_SMCR_BW_SHIFT)
31*4882a593Smuzhiyun #define NEMC_SMCR_BW_8 (0 << 6)
32*4882a593Smuzhiyun #define NEMC_SMCR_TAS_SHIFT 8
33*4882a593Smuzhiyun #define NEMC_SMCR_TAS_MASK (0xf << NEMC_SMCR_TAS_SHIFT)
34*4882a593Smuzhiyun #define NEMC_SMCR_TAH_SHIFT 12
35*4882a593Smuzhiyun #define NEMC_SMCR_TAH_MASK (0xf << NEMC_SMCR_TAH_SHIFT)
36*4882a593Smuzhiyun #define NEMC_SMCR_TBP_SHIFT 16
37*4882a593Smuzhiyun #define NEMC_SMCR_TBP_MASK (0xf << NEMC_SMCR_TBP_SHIFT)
38*4882a593Smuzhiyun #define NEMC_SMCR_TAW_SHIFT 20
39*4882a593Smuzhiyun #define NEMC_SMCR_TAW_MASK (0xf << NEMC_SMCR_TAW_SHIFT)
40*4882a593Smuzhiyun #define NEMC_SMCR_TSTRV_SHIFT 24
41*4882a593Smuzhiyun #define NEMC_SMCR_TSTRV_MASK (0x3f << NEMC_SMCR_TSTRV_SHIFT)
42*4882a593Smuzhiyun
43*4882a593Smuzhiyun #define NEMC_NFCSR_NFEn(n) BIT(((n) - 1) << 1)
44*4882a593Smuzhiyun #define NEMC_NFCSR_NFCEn(n) BIT((((n) - 1) << 1) + 1)
45*4882a593Smuzhiyun #define NEMC_NFCSR_TNFEn(n) BIT(16 + (n) - 1)
46*4882a593Smuzhiyun
47*4882a593Smuzhiyun struct jz_soc_info {
48*4882a593Smuzhiyun u8 tas_tah_cycles_max;
49*4882a593Smuzhiyun };
50*4882a593Smuzhiyun
51*4882a593Smuzhiyun struct jz4780_nemc {
52*4882a593Smuzhiyun spinlock_t lock;
53*4882a593Smuzhiyun struct device *dev;
54*4882a593Smuzhiyun const struct jz_soc_info *soc_info;
55*4882a593Smuzhiyun void __iomem *base;
56*4882a593Smuzhiyun struct clk *clk;
57*4882a593Smuzhiyun uint32_t clk_period;
58*4882a593Smuzhiyun unsigned long banks_present;
59*4882a593Smuzhiyun };
60*4882a593Smuzhiyun
61*4882a593Smuzhiyun /**
62*4882a593Smuzhiyun * jz4780_nemc_num_banks() - count the number of banks referenced by a device
63*4882a593Smuzhiyun * @dev: device to count banks for, must be a child of the NEMC.
64*4882a593Smuzhiyun *
65*4882a593Smuzhiyun * Return: The number of unique NEMC banks referred to by the specified NEMC
66*4882a593Smuzhiyun * child device. Unique here means that a device that references the same bank
67*4882a593Smuzhiyun * multiple times in its "reg" property will only count once.
68*4882a593Smuzhiyun */
jz4780_nemc_num_banks(struct device * dev)69*4882a593Smuzhiyun unsigned int jz4780_nemc_num_banks(struct device *dev)
70*4882a593Smuzhiyun {
71*4882a593Smuzhiyun const __be32 *prop;
72*4882a593Smuzhiyun unsigned int bank, count = 0;
73*4882a593Smuzhiyun unsigned long referenced = 0;
74*4882a593Smuzhiyun int i = 0;
75*4882a593Smuzhiyun
76*4882a593Smuzhiyun while ((prop = of_get_address(dev->of_node, i++, NULL, NULL))) {
77*4882a593Smuzhiyun bank = of_read_number(prop, 1);
78*4882a593Smuzhiyun if (!(referenced & BIT(bank))) {
79*4882a593Smuzhiyun referenced |= BIT(bank);
80*4882a593Smuzhiyun count++;
81*4882a593Smuzhiyun }
82*4882a593Smuzhiyun }
83*4882a593Smuzhiyun
84*4882a593Smuzhiyun return count;
85*4882a593Smuzhiyun }
86*4882a593Smuzhiyun EXPORT_SYMBOL(jz4780_nemc_num_banks);
87*4882a593Smuzhiyun
88*4882a593Smuzhiyun /**
89*4882a593Smuzhiyun * jz4780_nemc_set_type() - set the type of device connected to a bank
90*4882a593Smuzhiyun * @dev: child device of the NEMC.
91*4882a593Smuzhiyun * @bank: bank number to configure.
92*4882a593Smuzhiyun * @type: type of device connected to the bank.
93*4882a593Smuzhiyun */
jz4780_nemc_set_type(struct device * dev,unsigned int bank,enum jz4780_nemc_bank_type type)94*4882a593Smuzhiyun void jz4780_nemc_set_type(struct device *dev, unsigned int bank,
95*4882a593Smuzhiyun enum jz4780_nemc_bank_type type)
96*4882a593Smuzhiyun {
97*4882a593Smuzhiyun struct jz4780_nemc *nemc = dev_get_drvdata(dev->parent);
98*4882a593Smuzhiyun uint32_t nfcsr;
99*4882a593Smuzhiyun
100*4882a593Smuzhiyun nfcsr = readl(nemc->base + NEMC_NFCSR);
101*4882a593Smuzhiyun
102*4882a593Smuzhiyun /* TODO: Support toggle NAND devices. */
103*4882a593Smuzhiyun switch (type) {
104*4882a593Smuzhiyun case JZ4780_NEMC_BANK_SRAM:
105*4882a593Smuzhiyun nfcsr &= ~(NEMC_NFCSR_TNFEn(bank) | NEMC_NFCSR_NFEn(bank));
106*4882a593Smuzhiyun break;
107*4882a593Smuzhiyun case JZ4780_NEMC_BANK_NAND:
108*4882a593Smuzhiyun nfcsr &= ~NEMC_NFCSR_TNFEn(bank);
109*4882a593Smuzhiyun nfcsr |= NEMC_NFCSR_NFEn(bank);
110*4882a593Smuzhiyun break;
111*4882a593Smuzhiyun }
112*4882a593Smuzhiyun
113*4882a593Smuzhiyun writel(nfcsr, nemc->base + NEMC_NFCSR);
114*4882a593Smuzhiyun }
115*4882a593Smuzhiyun EXPORT_SYMBOL(jz4780_nemc_set_type);
116*4882a593Smuzhiyun
117*4882a593Smuzhiyun /**
118*4882a593Smuzhiyun * jz4780_nemc_assert() - (de-)assert a NAND device's chip enable pin
119*4882a593Smuzhiyun * @dev: child device of the NEMC.
120*4882a593Smuzhiyun * @bank: bank number of device.
121*4882a593Smuzhiyun * @assert: whether the chip enable pin should be asserted.
122*4882a593Smuzhiyun *
123*4882a593Smuzhiyun * (De-)asserts the chip enable pin for the NAND device connected to the
124*4882a593Smuzhiyun * specified bank.
125*4882a593Smuzhiyun */
jz4780_nemc_assert(struct device * dev,unsigned int bank,bool assert)126*4882a593Smuzhiyun void jz4780_nemc_assert(struct device *dev, unsigned int bank, bool assert)
127*4882a593Smuzhiyun {
128*4882a593Smuzhiyun struct jz4780_nemc *nemc = dev_get_drvdata(dev->parent);
129*4882a593Smuzhiyun uint32_t nfcsr;
130*4882a593Smuzhiyun
131*4882a593Smuzhiyun nfcsr = readl(nemc->base + NEMC_NFCSR);
132*4882a593Smuzhiyun
133*4882a593Smuzhiyun if (assert)
134*4882a593Smuzhiyun nfcsr |= NEMC_NFCSR_NFCEn(bank);
135*4882a593Smuzhiyun else
136*4882a593Smuzhiyun nfcsr &= ~NEMC_NFCSR_NFCEn(bank);
137*4882a593Smuzhiyun
138*4882a593Smuzhiyun writel(nfcsr, nemc->base + NEMC_NFCSR);
139*4882a593Smuzhiyun }
140*4882a593Smuzhiyun EXPORT_SYMBOL(jz4780_nemc_assert);
141*4882a593Smuzhiyun
jz4780_nemc_clk_period(struct jz4780_nemc * nemc)142*4882a593Smuzhiyun static uint32_t jz4780_nemc_clk_period(struct jz4780_nemc *nemc)
143*4882a593Smuzhiyun {
144*4882a593Smuzhiyun unsigned long rate;
145*4882a593Smuzhiyun
146*4882a593Smuzhiyun rate = clk_get_rate(nemc->clk);
147*4882a593Smuzhiyun if (!rate)
148*4882a593Smuzhiyun return 0;
149*4882a593Smuzhiyun
150*4882a593Smuzhiyun /* Return in picoseconds. */
151*4882a593Smuzhiyun return div64_ul(1000000000000ull, rate);
152*4882a593Smuzhiyun }
153*4882a593Smuzhiyun
jz4780_nemc_ns_to_cycles(struct jz4780_nemc * nemc,uint32_t ns)154*4882a593Smuzhiyun static uint32_t jz4780_nemc_ns_to_cycles(struct jz4780_nemc *nemc, uint32_t ns)
155*4882a593Smuzhiyun {
156*4882a593Smuzhiyun return ((ns * 1000) + nemc->clk_period - 1) / nemc->clk_period;
157*4882a593Smuzhiyun }
158*4882a593Smuzhiyun
jz4780_nemc_configure_bank(struct jz4780_nemc * nemc,unsigned int bank,struct device_node * node)159*4882a593Smuzhiyun static bool jz4780_nemc_configure_bank(struct jz4780_nemc *nemc,
160*4882a593Smuzhiyun unsigned int bank,
161*4882a593Smuzhiyun struct device_node *node)
162*4882a593Smuzhiyun {
163*4882a593Smuzhiyun uint32_t smcr, val, cycles;
164*4882a593Smuzhiyun
165*4882a593Smuzhiyun /*
166*4882a593Smuzhiyun * Conversion of tBP and tAW cycle counts to values supported by the
167*4882a593Smuzhiyun * hardware (round up to the next supported value).
168*4882a593Smuzhiyun */
169*4882a593Smuzhiyun static const u8 convert_tBP_tAW[] = {
170*4882a593Smuzhiyun 0, 1, 2, 3, 4, 5, 6, 7, 8, 9, 10,
171*4882a593Smuzhiyun
172*4882a593Smuzhiyun /* 11 - 12 -> 12 cycles */
173*4882a593Smuzhiyun 11, 11,
174*4882a593Smuzhiyun
175*4882a593Smuzhiyun /* 13 - 15 -> 15 cycles */
176*4882a593Smuzhiyun 12, 12, 12,
177*4882a593Smuzhiyun
178*4882a593Smuzhiyun /* 16 - 20 -> 20 cycles */
179*4882a593Smuzhiyun 13, 13, 13, 13, 13,
180*4882a593Smuzhiyun
181*4882a593Smuzhiyun /* 21 - 25 -> 25 cycles */
182*4882a593Smuzhiyun 14, 14, 14, 14, 14,
183*4882a593Smuzhiyun
184*4882a593Smuzhiyun /* 26 - 31 -> 31 cycles */
185*4882a593Smuzhiyun 15, 15, 15, 15, 15, 15
186*4882a593Smuzhiyun };
187*4882a593Smuzhiyun
188*4882a593Smuzhiyun smcr = readl(nemc->base + NEMC_SMCRn(bank));
189*4882a593Smuzhiyun smcr &= ~NEMC_SMCR_SMT;
190*4882a593Smuzhiyun
191*4882a593Smuzhiyun if (!of_property_read_u32(node, "ingenic,nemc-bus-width", &val)) {
192*4882a593Smuzhiyun smcr &= ~NEMC_SMCR_BW_MASK;
193*4882a593Smuzhiyun switch (val) {
194*4882a593Smuzhiyun case 8:
195*4882a593Smuzhiyun smcr |= NEMC_SMCR_BW_8;
196*4882a593Smuzhiyun break;
197*4882a593Smuzhiyun default:
198*4882a593Smuzhiyun /*
199*4882a593Smuzhiyun * Earlier SoCs support a 16 bit bus width (the 4780
200*4882a593Smuzhiyun * does not), until those are properly supported, error.
201*4882a593Smuzhiyun */
202*4882a593Smuzhiyun dev_err(nemc->dev, "unsupported bus width: %u\n", val);
203*4882a593Smuzhiyun return false;
204*4882a593Smuzhiyun }
205*4882a593Smuzhiyun }
206*4882a593Smuzhiyun
207*4882a593Smuzhiyun if (of_property_read_u32(node, "ingenic,nemc-tAS", &val) == 0) {
208*4882a593Smuzhiyun smcr &= ~NEMC_SMCR_TAS_MASK;
209*4882a593Smuzhiyun cycles = jz4780_nemc_ns_to_cycles(nemc, val);
210*4882a593Smuzhiyun if (cycles > nemc->soc_info->tas_tah_cycles_max) {
211*4882a593Smuzhiyun dev_err(nemc->dev, "tAS %u is too high (%u cycles)\n",
212*4882a593Smuzhiyun val, cycles);
213*4882a593Smuzhiyun return false;
214*4882a593Smuzhiyun }
215*4882a593Smuzhiyun
216*4882a593Smuzhiyun smcr |= cycles << NEMC_SMCR_TAS_SHIFT;
217*4882a593Smuzhiyun }
218*4882a593Smuzhiyun
219*4882a593Smuzhiyun if (of_property_read_u32(node, "ingenic,nemc-tAH", &val) == 0) {
220*4882a593Smuzhiyun smcr &= ~NEMC_SMCR_TAH_MASK;
221*4882a593Smuzhiyun cycles = jz4780_nemc_ns_to_cycles(nemc, val);
222*4882a593Smuzhiyun if (cycles > nemc->soc_info->tas_tah_cycles_max) {
223*4882a593Smuzhiyun dev_err(nemc->dev, "tAH %u is too high (%u cycles)\n",
224*4882a593Smuzhiyun val, cycles);
225*4882a593Smuzhiyun return false;
226*4882a593Smuzhiyun }
227*4882a593Smuzhiyun
228*4882a593Smuzhiyun smcr |= cycles << NEMC_SMCR_TAH_SHIFT;
229*4882a593Smuzhiyun }
230*4882a593Smuzhiyun
231*4882a593Smuzhiyun if (of_property_read_u32(node, "ingenic,nemc-tBP", &val) == 0) {
232*4882a593Smuzhiyun smcr &= ~NEMC_SMCR_TBP_MASK;
233*4882a593Smuzhiyun cycles = jz4780_nemc_ns_to_cycles(nemc, val);
234*4882a593Smuzhiyun if (cycles > 31) {
235*4882a593Smuzhiyun dev_err(nemc->dev, "tBP %u is too high (%u cycles)\n",
236*4882a593Smuzhiyun val, cycles);
237*4882a593Smuzhiyun return false;
238*4882a593Smuzhiyun }
239*4882a593Smuzhiyun
240*4882a593Smuzhiyun smcr |= convert_tBP_tAW[cycles] << NEMC_SMCR_TBP_SHIFT;
241*4882a593Smuzhiyun }
242*4882a593Smuzhiyun
243*4882a593Smuzhiyun if (of_property_read_u32(node, "ingenic,nemc-tAW", &val) == 0) {
244*4882a593Smuzhiyun smcr &= ~NEMC_SMCR_TAW_MASK;
245*4882a593Smuzhiyun cycles = jz4780_nemc_ns_to_cycles(nemc, val);
246*4882a593Smuzhiyun if (cycles > 31) {
247*4882a593Smuzhiyun dev_err(nemc->dev, "tAW %u is too high (%u cycles)\n",
248*4882a593Smuzhiyun val, cycles);
249*4882a593Smuzhiyun return false;
250*4882a593Smuzhiyun }
251*4882a593Smuzhiyun
252*4882a593Smuzhiyun smcr |= convert_tBP_tAW[cycles] << NEMC_SMCR_TAW_SHIFT;
253*4882a593Smuzhiyun }
254*4882a593Smuzhiyun
255*4882a593Smuzhiyun if (of_property_read_u32(node, "ingenic,nemc-tSTRV", &val) == 0) {
256*4882a593Smuzhiyun smcr &= ~NEMC_SMCR_TSTRV_MASK;
257*4882a593Smuzhiyun cycles = jz4780_nemc_ns_to_cycles(nemc, val);
258*4882a593Smuzhiyun if (cycles > 63) {
259*4882a593Smuzhiyun dev_err(nemc->dev, "tSTRV %u is too high (%u cycles)\n",
260*4882a593Smuzhiyun val, cycles);
261*4882a593Smuzhiyun return false;
262*4882a593Smuzhiyun }
263*4882a593Smuzhiyun
264*4882a593Smuzhiyun smcr |= cycles << NEMC_SMCR_TSTRV_SHIFT;
265*4882a593Smuzhiyun }
266*4882a593Smuzhiyun
267*4882a593Smuzhiyun writel(smcr, nemc->base + NEMC_SMCRn(bank));
268*4882a593Smuzhiyun return true;
269*4882a593Smuzhiyun }
270*4882a593Smuzhiyun
jz4780_nemc_probe(struct platform_device * pdev)271*4882a593Smuzhiyun static int jz4780_nemc_probe(struct platform_device *pdev)
272*4882a593Smuzhiyun {
273*4882a593Smuzhiyun struct device *dev = &pdev->dev;
274*4882a593Smuzhiyun struct jz4780_nemc *nemc;
275*4882a593Smuzhiyun struct resource *res;
276*4882a593Smuzhiyun struct device_node *child;
277*4882a593Smuzhiyun const __be32 *prop;
278*4882a593Smuzhiyun unsigned int bank;
279*4882a593Smuzhiyun unsigned long referenced;
280*4882a593Smuzhiyun int i, ret;
281*4882a593Smuzhiyun
282*4882a593Smuzhiyun nemc = devm_kzalloc(dev, sizeof(*nemc), GFP_KERNEL);
283*4882a593Smuzhiyun if (!nemc)
284*4882a593Smuzhiyun return -ENOMEM;
285*4882a593Smuzhiyun
286*4882a593Smuzhiyun nemc->soc_info = device_get_match_data(dev);
287*4882a593Smuzhiyun if (!nemc->soc_info)
288*4882a593Smuzhiyun return -EINVAL;
289*4882a593Smuzhiyun
290*4882a593Smuzhiyun spin_lock_init(&nemc->lock);
291*4882a593Smuzhiyun nemc->dev = dev;
292*4882a593Smuzhiyun
293*4882a593Smuzhiyun res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
294*4882a593Smuzhiyun if (!res)
295*4882a593Smuzhiyun return -EINVAL;
296*4882a593Smuzhiyun
297*4882a593Smuzhiyun /*
298*4882a593Smuzhiyun * The driver currently only uses the registers up to offset
299*4882a593Smuzhiyun * NEMC_REG_LEN. Since the EFUSE registers are in the middle of the
300*4882a593Smuzhiyun * NEMC registers, we only request the registers we will use for now;
301*4882a593Smuzhiyun * that way the EFUSE driver can probe too.
302*4882a593Smuzhiyun */
303*4882a593Smuzhiyun if (!devm_request_mem_region(dev, res->start, NEMC_REG_LEN, dev_name(dev))) {
304*4882a593Smuzhiyun dev_err(dev, "unable to request I/O memory region\n");
305*4882a593Smuzhiyun return -EBUSY;
306*4882a593Smuzhiyun }
307*4882a593Smuzhiyun
308*4882a593Smuzhiyun nemc->base = devm_ioremap(dev, res->start, NEMC_REG_LEN);
309*4882a593Smuzhiyun if (!nemc->base) {
310*4882a593Smuzhiyun dev_err(dev, "failed to get I/O memory\n");
311*4882a593Smuzhiyun return -ENOMEM;
312*4882a593Smuzhiyun }
313*4882a593Smuzhiyun
314*4882a593Smuzhiyun writel(0, nemc->base + NEMC_NFCSR);
315*4882a593Smuzhiyun
316*4882a593Smuzhiyun nemc->clk = devm_clk_get(dev, NULL);
317*4882a593Smuzhiyun if (IS_ERR(nemc->clk)) {
318*4882a593Smuzhiyun dev_err(dev, "failed to get clock\n");
319*4882a593Smuzhiyun return PTR_ERR(nemc->clk);
320*4882a593Smuzhiyun }
321*4882a593Smuzhiyun
322*4882a593Smuzhiyun ret = clk_prepare_enable(nemc->clk);
323*4882a593Smuzhiyun if (ret) {
324*4882a593Smuzhiyun dev_err(dev, "failed to enable clock: %d\n", ret);
325*4882a593Smuzhiyun return ret;
326*4882a593Smuzhiyun }
327*4882a593Smuzhiyun
328*4882a593Smuzhiyun nemc->clk_period = jz4780_nemc_clk_period(nemc);
329*4882a593Smuzhiyun if (!nemc->clk_period) {
330*4882a593Smuzhiyun dev_err(dev, "failed to calculate clock period\n");
331*4882a593Smuzhiyun clk_disable_unprepare(nemc->clk);
332*4882a593Smuzhiyun return -EINVAL;
333*4882a593Smuzhiyun }
334*4882a593Smuzhiyun
335*4882a593Smuzhiyun /*
336*4882a593Smuzhiyun * Iterate over child devices, check that they do not conflict with
337*4882a593Smuzhiyun * each other, and register child devices for them. If a child device
338*4882a593Smuzhiyun * has invalid properties, it is ignored and no platform device is
339*4882a593Smuzhiyun * registered for it.
340*4882a593Smuzhiyun */
341*4882a593Smuzhiyun for_each_child_of_node(nemc->dev->of_node, child) {
342*4882a593Smuzhiyun referenced = 0;
343*4882a593Smuzhiyun i = 0;
344*4882a593Smuzhiyun while ((prop = of_get_address(child, i++, NULL, NULL))) {
345*4882a593Smuzhiyun bank = of_read_number(prop, 1);
346*4882a593Smuzhiyun if (bank < 1 || bank >= JZ4780_NEMC_NUM_BANKS) {
347*4882a593Smuzhiyun dev_err(nemc->dev,
348*4882a593Smuzhiyun "%pOF requests invalid bank %u\n",
349*4882a593Smuzhiyun child, bank);
350*4882a593Smuzhiyun
351*4882a593Smuzhiyun /* Will continue the outer loop below. */
352*4882a593Smuzhiyun referenced = 0;
353*4882a593Smuzhiyun break;
354*4882a593Smuzhiyun }
355*4882a593Smuzhiyun
356*4882a593Smuzhiyun referenced |= BIT(bank);
357*4882a593Smuzhiyun }
358*4882a593Smuzhiyun
359*4882a593Smuzhiyun if (!referenced) {
360*4882a593Smuzhiyun dev_err(nemc->dev, "%pOF has no addresses\n",
361*4882a593Smuzhiyun child);
362*4882a593Smuzhiyun continue;
363*4882a593Smuzhiyun } else if (nemc->banks_present & referenced) {
364*4882a593Smuzhiyun dev_err(nemc->dev, "%pOF conflicts with another node\n",
365*4882a593Smuzhiyun child);
366*4882a593Smuzhiyun continue;
367*4882a593Smuzhiyun }
368*4882a593Smuzhiyun
369*4882a593Smuzhiyun /* Configure bank parameters. */
370*4882a593Smuzhiyun for_each_set_bit(bank, &referenced, JZ4780_NEMC_NUM_BANKS) {
371*4882a593Smuzhiyun if (!jz4780_nemc_configure_bank(nemc, bank, child)) {
372*4882a593Smuzhiyun referenced = 0;
373*4882a593Smuzhiyun break;
374*4882a593Smuzhiyun }
375*4882a593Smuzhiyun }
376*4882a593Smuzhiyun
377*4882a593Smuzhiyun if (referenced) {
378*4882a593Smuzhiyun if (of_platform_device_create(child, NULL, nemc->dev))
379*4882a593Smuzhiyun nemc->banks_present |= referenced;
380*4882a593Smuzhiyun }
381*4882a593Smuzhiyun }
382*4882a593Smuzhiyun
383*4882a593Smuzhiyun platform_set_drvdata(pdev, nemc);
384*4882a593Smuzhiyun dev_info(dev, "JZ4780 NEMC initialised\n");
385*4882a593Smuzhiyun return 0;
386*4882a593Smuzhiyun }
387*4882a593Smuzhiyun
jz4780_nemc_remove(struct platform_device * pdev)388*4882a593Smuzhiyun static int jz4780_nemc_remove(struct platform_device *pdev)
389*4882a593Smuzhiyun {
390*4882a593Smuzhiyun struct jz4780_nemc *nemc = platform_get_drvdata(pdev);
391*4882a593Smuzhiyun
392*4882a593Smuzhiyun clk_disable_unprepare(nemc->clk);
393*4882a593Smuzhiyun return 0;
394*4882a593Smuzhiyun }
395*4882a593Smuzhiyun
396*4882a593Smuzhiyun static const struct jz_soc_info jz4740_soc_info = {
397*4882a593Smuzhiyun .tas_tah_cycles_max = 7,
398*4882a593Smuzhiyun };
399*4882a593Smuzhiyun
400*4882a593Smuzhiyun static const struct jz_soc_info jz4780_soc_info = {
401*4882a593Smuzhiyun .tas_tah_cycles_max = 15,
402*4882a593Smuzhiyun };
403*4882a593Smuzhiyun
404*4882a593Smuzhiyun static const struct of_device_id jz4780_nemc_dt_match[] = {
405*4882a593Smuzhiyun { .compatible = "ingenic,jz4740-nemc", .data = &jz4740_soc_info, },
406*4882a593Smuzhiyun { .compatible = "ingenic,jz4780-nemc", .data = &jz4780_soc_info, },
407*4882a593Smuzhiyun {},
408*4882a593Smuzhiyun };
409*4882a593Smuzhiyun
410*4882a593Smuzhiyun static struct platform_driver jz4780_nemc_driver = {
411*4882a593Smuzhiyun .probe = jz4780_nemc_probe,
412*4882a593Smuzhiyun .remove = jz4780_nemc_remove,
413*4882a593Smuzhiyun .driver = {
414*4882a593Smuzhiyun .name = "jz4780-nemc",
415*4882a593Smuzhiyun .of_match_table = of_match_ptr(jz4780_nemc_dt_match),
416*4882a593Smuzhiyun },
417*4882a593Smuzhiyun };
418*4882a593Smuzhiyun
jz4780_nemc_init(void)419*4882a593Smuzhiyun static int __init jz4780_nemc_init(void)
420*4882a593Smuzhiyun {
421*4882a593Smuzhiyun return platform_driver_register(&jz4780_nemc_driver);
422*4882a593Smuzhiyun }
423*4882a593Smuzhiyun subsys_initcall(jz4780_nemc_init);
424