1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24#include <common.h>
25#include <asm/io.h>
26#include <asm/errno.h>
27#include <asm/arch/mem.h>
28#include <asm/arch/omap_gpmc.h>
29#include <linux/mtd/nand_ecc.h>
30#include <nand.h>
31
32static uint8_t cs;
33static struct nand_ecclayout hw_nand_oob = GPMC_NAND_HW_ECC_LAYOUT;
34
35
36
37
38
39static void omap_nand_hwcontrol(struct mtd_info *mtd, int32_t cmd,
40 uint32_t ctrl)
41{
42 register struct nand_chip *this = mtd->priv;
43
44
45
46
47
48 switch (ctrl) {
49 case NAND_CTRL_CHANGE | NAND_CTRL_CLE:
50 this->IO_ADDR_W = (void __iomem *)&gpmc_cfg->cs[cs].nand_cmd;
51 break;
52 case NAND_CTRL_CHANGE | NAND_CTRL_ALE:
53 this->IO_ADDR_W = (void __iomem *)&gpmc_cfg->cs[cs].nand_adr;
54 break;
55 case NAND_CTRL_CHANGE | NAND_NCE:
56 this->IO_ADDR_W = (void __iomem *)&gpmc_cfg->cs[cs].nand_dat;
57 break;
58 }
59
60 if (cmd != NAND_CMD_NONE)
61 writeb(cmd, this->IO_ADDR_W);
62}
63
64#ifdef CONFIG_SPL_BUILD
65
66int omap_spl_dev_ready(struct mtd_info *mtd)
67{
68 return gpmc_cfg->status & (1 << 8);
69}
70#endif
71
72
73
74
75
76
77
78static void omap_hwecc_init(struct nand_chip *chip)
79{
80
81
82
83
84 writel(ECCCLEAR | ECCRESULTREG1, &gpmc_cfg->ecc_control);
85 writel(ECCSIZE1 | ECCSIZE0 | ECCSIZE0SEL, &gpmc_cfg->ecc_size_config);
86}
87
88
89
90
91
92
93
94
95
96static uint32_t gen_true_ecc(uint8_t *ecc_buf)
97{
98 return ecc_buf[0] | (ecc_buf[1] << 16) | ((ecc_buf[2] & 0xF0) << 20) |
99 ((ecc_buf[2] & 0x0F) << 8);
100}
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116static int omap_correct_data(struct mtd_info *mtd, uint8_t *dat,
117 uint8_t *read_ecc, uint8_t *calc_ecc)
118{
119 uint32_t orig_ecc, new_ecc, res, hm;
120 uint16_t parity_bits, byte;
121 uint8_t bit;
122
123
124 orig_ecc = gen_true_ecc(read_ecc);
125 new_ecc = gen_true_ecc(calc_ecc);
126
127 res = orig_ecc ^ new_ecc;
128 if (res) {
129
130 hm = hweight32(res);
131
132 if (hm == 12) {
133
134 parity_bits = res >> 16;
135 bit = (parity_bits & 0x7);
136 byte = (parity_bits >> 3) & 0x1FF;
137
138 dat[byte] ^= (0x1 << bit);
139 } else if (hm == 1) {
140 printf("Error: Ecc is wrong\n");
141
142 return 2;
143 } else {
144
145
146
147
148
149
150
151
152
153
154
155
156
157 if ((orig_ecc == 0x0FFF0FFF) && (new_ecc == 0x00000000))
158 return 0;
159 printf("Error: Bad compare! failed\n");
160
161 return -1;
162 }
163 }
164 return 0;
165}
166
167
168
169
170
171
172
173
174
175
176
177
178
179
180
181
182static int omap_calculate_ecc(struct mtd_info *mtd, const uint8_t *dat,
183 uint8_t *ecc_code)
184{
185 u_int32_t val;
186
187
188 val = readl(&gpmc_cfg->ecc1_result);
189
190 ecc_code[0] = val & 0xFF;
191 ecc_code[1] = (val >> 16) & 0xFF;
192 ecc_code[2] = ((val >> 8) & 0x0F) | ((val >> 20) & 0xF0);
193
194
195
196
197
198 writel(0x000, &gpmc_cfg->ecc_config);
199
200 return 0;
201}
202
203
204
205
206
207
208static void omap_enable_hwecc(struct mtd_info *mtd, int32_t mode)
209{
210 struct nand_chip *chip = mtd->priv;
211 uint32_t val, dev_width = (chip->options & NAND_BUSWIDTH_16) >> 1;
212
213 switch (mode) {
214 case NAND_ECC_READ:
215 case NAND_ECC_WRITE:
216
217 writel(ECCCLEAR | ECCRESULTREG1, &gpmc_cfg->ecc_control);
218
219
220
221
222
223
224 writel(ECCSIZE1 | ECCSIZE0 | ECCSIZE0SEL,
225 &gpmc_cfg->ecc_size_config);
226 val = (dev_width << 7) | (cs << 1) | (0x1);
227 writel(val, &gpmc_cfg->ecc_config);
228 break;
229 default:
230 printf("Error: Unrecognized Mode[%d]!\n", mode);
231 break;
232 }
233}
234
235#ifndef CONFIG_SPL_BUILD
236
237
238
239
240
241
242
243void omap_nand_switch_ecc(int32_t hardware)
244{
245 struct nand_chip *nand;
246 struct mtd_info *mtd;
247
248 if (nand_curr_device < 0 ||
249 nand_curr_device >= CONFIG_SYS_MAX_NAND_DEVICE ||
250 !nand_info[nand_curr_device].name) {
251 printf("Error: Can't switch ecc, no devices available\n");
252 return;
253 }
254
255 mtd = &nand_info[nand_curr_device];
256 nand = mtd->priv;
257
258 nand->options |= NAND_OWN_BUFFERS;
259
260
261 nand->ecc.read_page = NULL;
262 nand->ecc.write_page = NULL;
263 nand->ecc.read_oob = NULL;
264 nand->ecc.write_oob = NULL;
265 nand->ecc.hwctl = NULL;
266 nand->ecc.correct = NULL;
267 nand->ecc.calculate = NULL;
268
269
270 if (hardware) {
271 nand->ecc.mode = NAND_ECC_HW;
272 nand->ecc.layout = &hw_nand_oob;
273 nand->ecc.size = 512;
274 nand->ecc.bytes = 3;
275 nand->ecc.hwctl = omap_enable_hwecc;
276 nand->ecc.correct = omap_correct_data;
277 nand->ecc.calculate = omap_calculate_ecc;
278 omap_hwecc_init(nand);
279 printf("HW ECC selected\n");
280 } else {
281 nand->ecc.mode = NAND_ECC_SOFT;
282
283 nand->ecc.layout = NULL;
284 printf("SW ECC selected\n");
285 }
286
287
288 nand_scan_tail(mtd);
289
290 nand->options &= ~NAND_OWN_BUFFERS;
291}
292#endif
293
294
295
296
297
298
299
300
301
302
303
304
305
306
307
308
309int board_nand_init(struct nand_chip *nand)
310{
311 int32_t gpmc_config = 0;
312 cs = 0;
313
314
315
316
317
318
319
320
321 while (cs < GPMC_MAX_CS) {
322
323 if ((readl(&gpmc_cfg->cs[cs].config1) & 0xC00) == 0x800) {
324
325 break;
326 }
327 cs++;
328 }
329 if (cs >= GPMC_MAX_CS) {
330 printf("NAND: Unable to find NAND settings in "
331 "GPMC Configuration - quitting\n");
332 return -ENODEV;
333 }
334
335 gpmc_config = readl(&gpmc_cfg->config);
336
337 gpmc_config |= 0x10;
338 writel(gpmc_config, &gpmc_cfg->config);
339
340 nand->IO_ADDR_R = (void __iomem *)&gpmc_cfg->cs[cs].nand_dat;
341 nand->IO_ADDR_W = (void __iomem *)&gpmc_cfg->cs[cs].nand_cmd;
342
343 nand->cmd_ctrl = omap_nand_hwcontrol;
344 nand->options = NAND_NO_PADDING | NAND_CACHEPRG | NAND_NO_AUTOINCR;
345
346 if ((readl(&gpmc_cfg->cs[cs].config1) & 0x3000) == 0x1000)
347 nand->options |= NAND_BUSWIDTH_16;
348
349 nand->chip_delay = 100;
350
351#if !defined(CONFIG_SPL_BUILD) || defined(CONFIG_SPL_NAND_SOFTECC)
352 nand->ecc.mode = NAND_ECC_SOFT;
353#else
354 nand->ecc.mode = NAND_ECC_HW;
355 nand->ecc.layout = &hw_nand_oob;
356 nand->ecc.size = CONFIG_SYS_NAND_ECCSIZE;
357 nand->ecc.bytes = CONFIG_SYS_NAND_ECCBYTES;
358 nand->ecc.hwctl = omap_enable_hwecc;
359 nand->ecc.correct = omap_correct_data;
360 nand->ecc.calculate = omap_calculate_ecc;
361 omap_hwecc_init(nand);
362#endif
363
364#ifdef CONFIG_SPL_BUILD
365 if (nand->options & NAND_BUSWIDTH_16)
366 nand->read_buf = nand_read_buf16;
367 else
368 nand->read_buf = nand_read_buf;
369 nand->dev_ready = omap_spl_dev_ready;
370#endif
371
372 return 0;
373}
374