1
2
3
4
5
6
7
8
9
10
11
12
13
14
15#include <linux/slab.h>
16#include <linux/mtd/mtd.h>
17#include <linux/mtd/onenand.h>
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32static int check_short_pattern(uint8_t *buf, int len, int paglen, struct nand_bbt_descr *td)
33{
34 int i;
35 uint8_t *p = buf;
36
37
38 for (i = 0; i < td->len; i++) {
39 if (p[i] != td->pattern[i])
40 return -1;
41 }
42 return 0;
43}
44
45
46
47
48
49
50
51
52
53
54
55
56static int create_bbt(struct mtd_info *mtd, uint8_t *buf, struct nand_bbt_descr *bd, int chip)
57{
58 struct onenand_chip *this = mtd->priv;
59 struct bbm_info *bbm = this->bbm;
60 int i, j, numblocks, len, scanlen;
61 int startblock;
62 loff_t from;
63 size_t readlen, ooblen;
64 struct mtd_oob_ops ops;
65 int rgn;
66
67 printk(KERN_INFO "Scanning device for bad blocks\n");
68
69 len = 2;
70
71
72 scanlen = ooblen = 0;
73 readlen = bd->len;
74
75
76
77
78
79 numblocks = this->chipsize >> (bbm->bbt_erase_shift - 1);
80 startblock = 0;
81 from = 0;
82
83 ops.mode = MTD_OOB_PLACE;
84 ops.ooblen = readlen;
85 ops.oobbuf = buf;
86 ops.len = ops.ooboffs = ops.retlen = ops.oobretlen = 0;
87
88 for (i = startblock; i < numblocks; ) {
89 int ret;
90
91 for (j = 0; j < len; j++) {
92
93
94 ret = onenand_bbt_read_oob(mtd,
95 from + j * this->writesize + bd->offs, &ops);
96
97
98 if (ret == ONENAND_BBT_READ_FATAL_ERROR)
99 return -EIO;
100
101 if (ret || check_short_pattern(&buf[j * scanlen],
102 scanlen, this->writesize, bd)) {
103 bbm->bbt[i >> 3] |= 0x03 << (i & 0x6);
104 printk(KERN_INFO "OneNAND eraseblock %d is an "
105 "initial bad block\n", i >> 1);
106 mtd->ecc_stats.badblocks++;
107 break;
108 }
109 }
110 i += 2;
111
112 if (FLEXONENAND(this)) {
113 rgn = flexonenand_region(mtd, from);
114 from += mtd->eraseregions[rgn].erasesize;
115 } else
116 from += (1 << bbm->bbt_erase_shift);
117 }
118
119 return 0;
120}
121
122
123
124
125
126
127
128
129
130
131static inline int onenand_memory_bbt (struct mtd_info *mtd, struct nand_bbt_descr *bd)
132{
133 struct onenand_chip *this = mtd->priv;
134
135 bd->options &= ~NAND_BBT_SCANEMPTY;
136 return create_bbt(mtd, this->page_buf, bd, -1);
137}
138
139
140
141
142
143
144
145static int onenand_isbad_bbt(struct mtd_info *mtd, loff_t offs, int allowbbt)
146{
147 struct onenand_chip *this = mtd->priv;
148 struct bbm_info *bbm = this->bbm;
149 int block;
150 uint8_t res;
151
152
153 block = (int) (onenand_block(this, offs) << 1);
154 res = (bbm->bbt[block >> 3] >> (block & 0x06)) & 0x03;
155
156 DEBUG(MTD_DEBUG_LEVEL2, "onenand_isbad_bbt: bbt info for offs 0x%08x: (block %d) 0x%02x\n",
157 (unsigned int) offs, block >> 1, res);
158
159 switch ((int) res) {
160 case 0x00: return 0;
161 case 0x01: return 1;
162 case 0x02: return allowbbt ? 0 : 1;
163 }
164
165 return 1;
166}
167
168
169
170
171
172
173
174
175
176
177
178
179
180
181
182int onenand_scan_bbt(struct mtd_info *mtd, struct nand_bbt_descr *bd)
183{
184 struct onenand_chip *this = mtd->priv;
185 struct bbm_info *bbm = this->bbm;
186 int len, ret = 0;
187
188 len = this->chipsize >> (this->erase_shift + 2);
189
190 bbm->bbt = kzalloc(len, GFP_KERNEL);
191 if (!bbm->bbt) {
192 printk(KERN_ERR "onenand_scan_bbt: Out of memory\n");
193 return -ENOMEM;
194 }
195
196
197 bbm->badblockpos = ONENAND_BADBLOCK_POS;
198
199
200 bbm->bbt_erase_shift = this->erase_shift;
201
202 if (!bbm->isbad_bbt)
203 bbm->isbad_bbt = onenand_isbad_bbt;
204
205
206 if ((ret = onenand_memory_bbt(mtd, bd))) {
207 printk(KERN_ERR "onenand_scan_bbt: Can't scan flash and build the RAM-based BBT\n");
208 kfree(bbm->bbt);
209 bbm->bbt = NULL;
210 }
211
212 return ret;
213}
214
215
216
217
218
219static uint8_t scan_ff_pattern[] = { 0xff, 0xff };
220
221static struct nand_bbt_descr largepage_memorybased = {
222 .options = 0,
223 .offs = 0,
224 .len = 2,
225 .pattern = scan_ff_pattern,
226};
227
228
229
230
231
232
233
234
235int onenand_default_bbt(struct mtd_info *mtd)
236{
237 struct onenand_chip *this = mtd->priv;
238 struct bbm_info *bbm;
239
240 this->bbm = kzalloc(sizeof(struct bbm_info), GFP_KERNEL);
241 if (!this->bbm)
242 return -ENOMEM;
243
244 bbm = this->bbm;
245
246
247 if (!bbm->badblock_pattern)
248 bbm->badblock_pattern = &largepage_memorybased;
249
250 return onenand_scan_bbt(mtd, bbm->badblock_pattern);
251}
252
253EXPORT_SYMBOL(onenand_scan_bbt);
254EXPORT_SYMBOL(onenand_default_bbt);
255