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