xref: /openbmc/u-boot/drivers/mtd/ubi/attach.c (revision ee7bb5be)
1 /*
2  * Copyright (c) International Business Machines Corp., 2006
3  *
4  * SPDX-License-Identifier:	GPL-2.0+
5  *
6  * Author: Artem Bityutskiy (Битюцкий Артём)
7  */
8 
9 /*
10  * UBI attaching sub-system.
11  *
12  * This sub-system is responsible for attaching MTD devices and it also
13  * implements flash media scanning.
14  *
15  * The attaching information is represented by a &struct ubi_attach_info'
16  * object. Information about volumes is represented by &struct ubi_ainf_volume
17  * objects which are kept in volume RB-tree with root at the @volumes field.
18  * The RB-tree is indexed by the volume ID.
19  *
20  * Logical eraseblocks are represented by &struct ubi_ainf_peb objects. These
21  * objects are kept in per-volume RB-trees with the root at the corresponding
22  * &struct ubi_ainf_volume object. To put it differently, we keep an RB-tree of
23  * per-volume objects and each of these objects is the root of RB-tree of
24  * per-LEB objects.
25  *
26  * Corrupted physical eraseblocks are put to the @corr list, free physical
27  * eraseblocks are put to the @free list and the physical eraseblock to be
28  * erased are put to the @erase list.
29  *
30  * About corruptions
31  * ~~~~~~~~~~~~~~~~~
32  *
33  * UBI protects EC and VID headers with CRC-32 checksums, so it can detect
34  * whether the headers are corrupted or not. Sometimes UBI also protects the
35  * data with CRC-32, e.g., when it executes the atomic LEB change operation, or
36  * when it moves the contents of a PEB for wear-leveling purposes.
37  *
38  * UBI tries to distinguish between 2 types of corruptions.
39  *
40  * 1. Corruptions caused by power cuts. These are expected corruptions and UBI
41  * tries to handle them gracefully, without printing too many warnings and
42  * error messages. The idea is that we do not lose important data in these
43  * cases - we may lose only the data which were being written to the media just
44  * before the power cut happened, and the upper layers (e.g., UBIFS) are
45  * supposed to handle such data losses (e.g., by using the FS journal).
46  *
47  * When UBI detects a corruption (CRC-32 mismatch) in a PEB, and it looks like
48  * the reason is a power cut, UBI puts this PEB to the @erase list, and all
49  * PEBs in the @erase list are scheduled for erasure later.
50  *
51  * 2. Unexpected corruptions which are not caused by power cuts. During
52  * attaching, such PEBs are put to the @corr list and UBI preserves them.
53  * Obviously, this lessens the amount of available PEBs, and if at some  point
54  * UBI runs out of free PEBs, it switches to R/O mode. UBI also loudly informs
55  * about such PEBs every time the MTD device is attached.
56  *
57  * However, it is difficult to reliably distinguish between these types of
58  * corruptions and UBI's strategy is as follows (in case of attaching by
59  * scanning). UBI assumes corruption type 2 if the VID header is corrupted and
60  * the data area does not contain all 0xFFs, and there were no bit-flips or
61  * integrity errors (e.g., ECC errors in case of NAND) while reading the data
62  * area.  Otherwise UBI assumes corruption type 1. So the decision criteria
63  * are as follows.
64  *   o If the data area contains only 0xFFs, there are no data, and it is safe
65  *     to just erase this PEB - this is corruption type 1.
66  *   o If the data area has bit-flips or data integrity errors (ECC errors on
67  *     NAND), it is probably a PEB which was being erased when power cut
68  *     happened, so this is corruption type 1. However, this is just a guess,
69  *     which might be wrong.
70  *   o Otherwise this is corruption type 2.
71  */
72 
73 #ifndef __UBOOT__
74 #include <linux/err.h>
75 #include <linux/slab.h>
76 #include <linux/crc32.h>
77 #include <linux/random.h>
78 #else
79 #include <div64.h>
80 #include <linux/err.h>
81 #endif
82 
83 #include <linux/math64.h>
84 
85 #include <ubi_uboot.h>
86 #include "ubi.h"
87 
88 static int self_check_ai(struct ubi_device *ubi, struct ubi_attach_info *ai);
89 
90 /* Temporary variables used during scanning */
91 static struct ubi_ec_hdr *ech;
92 static struct ubi_vid_hdr *vidh;
93 
94 /**
95  * add_to_list - add physical eraseblock to a list.
96  * @ai: attaching information
97  * @pnum: physical eraseblock number to add
98  * @vol_id: the last used volume id for the PEB
99  * @lnum: the last used LEB number for the PEB
100  * @ec: erase counter of the physical eraseblock
101  * @to_head: if not zero, add to the head of the list
102  * @list: the list to add to
103  *
104  * This function allocates a 'struct ubi_ainf_peb' object for physical
105  * eraseblock @pnum and adds it to the "free", "erase", or "alien" lists.
106  * It stores the @lnum and @vol_id alongside, which can both be
107  * %UBI_UNKNOWN if they are not available, not readable, or not assigned.
108  * If @to_head is not zero, PEB will be added to the head of the list, which
109  * basically means it will be processed first later. E.g., we add corrupted
110  * PEBs (corrupted due to power cuts) to the head of the erase list to make
111  * sure we erase them first and get rid of corruptions ASAP. This function
112  * returns zero in case of success and a negative error code in case of
113  * failure.
114  */
115 static int add_to_list(struct ubi_attach_info *ai, int pnum, int vol_id,
116 		       int lnum, int ec, int to_head, struct list_head *list)
117 {
118 	struct ubi_ainf_peb *aeb;
119 
120 	if (list == &ai->free) {
121 		dbg_bld("add to free: PEB %d, EC %d", pnum, ec);
122 	} else if (list == &ai->erase) {
123 		dbg_bld("add to erase: PEB %d, EC %d", pnum, ec);
124 	} else if (list == &ai->alien) {
125 		dbg_bld("add to alien: PEB %d, EC %d", pnum, ec);
126 		ai->alien_peb_count += 1;
127 	} else
128 		BUG();
129 
130 	aeb = kmem_cache_alloc(ai->aeb_slab_cache, GFP_KERNEL);
131 	if (!aeb)
132 		return -ENOMEM;
133 
134 	aeb->pnum = pnum;
135 	aeb->vol_id = vol_id;
136 	aeb->lnum = lnum;
137 	aeb->ec = ec;
138 	if (to_head)
139 		list_add(&aeb->u.list, list);
140 	else
141 		list_add_tail(&aeb->u.list, list);
142 	return 0;
143 }
144 
145 /**
146  * add_corrupted - add a corrupted physical eraseblock.
147  * @ai: attaching information
148  * @pnum: physical eraseblock number to add
149  * @ec: erase counter of the physical eraseblock
150  *
151  * This function allocates a 'struct ubi_ainf_peb' object for a corrupted
152  * physical eraseblock @pnum and adds it to the 'corr' list.  The corruption
153  * was presumably not caused by a power cut. Returns zero in case of success
154  * and a negative error code in case of failure.
155  */
156 static int add_corrupted(struct ubi_attach_info *ai, int pnum, int ec)
157 {
158 	struct ubi_ainf_peb *aeb;
159 
160 	dbg_bld("add to corrupted: PEB %d, EC %d", pnum, ec);
161 
162 	aeb = kmem_cache_alloc(ai->aeb_slab_cache, GFP_KERNEL);
163 	if (!aeb)
164 		return -ENOMEM;
165 
166 	ai->corr_peb_count += 1;
167 	aeb->pnum = pnum;
168 	aeb->ec = ec;
169 	list_add(&aeb->u.list, &ai->corr);
170 	return 0;
171 }
172 
173 /**
174  * validate_vid_hdr - check volume identifier header.
175  * @ubi: UBI device description object
176  * @vid_hdr: the volume identifier header to check
177  * @av: information about the volume this logical eraseblock belongs to
178  * @pnum: physical eraseblock number the VID header came from
179  *
180  * This function checks that data stored in @vid_hdr is consistent. Returns
181  * non-zero if an inconsistency was found and zero if not.
182  *
183  * Note, UBI does sanity check of everything it reads from the flash media.
184  * Most of the checks are done in the I/O sub-system. Here we check that the
185  * information in the VID header is consistent to the information in other VID
186  * headers of the same volume.
187  */
188 static int validate_vid_hdr(const struct ubi_device *ubi,
189 			    const struct ubi_vid_hdr *vid_hdr,
190 			    const struct ubi_ainf_volume *av, int pnum)
191 {
192 	int vol_type = vid_hdr->vol_type;
193 	int vol_id = be32_to_cpu(vid_hdr->vol_id);
194 	int used_ebs = be32_to_cpu(vid_hdr->used_ebs);
195 	int data_pad = be32_to_cpu(vid_hdr->data_pad);
196 
197 	if (av->leb_count != 0) {
198 		int av_vol_type;
199 
200 		/*
201 		 * This is not the first logical eraseblock belonging to this
202 		 * volume. Ensure that the data in its VID header is consistent
203 		 * to the data in previous logical eraseblock headers.
204 		 */
205 
206 		if (vol_id != av->vol_id) {
207 			ubi_err(ubi, "inconsistent vol_id");
208 			goto bad;
209 		}
210 
211 		if (av->vol_type == UBI_STATIC_VOLUME)
212 			av_vol_type = UBI_VID_STATIC;
213 		else
214 			av_vol_type = UBI_VID_DYNAMIC;
215 
216 		if (vol_type != av_vol_type) {
217 			ubi_err(ubi, "inconsistent vol_type");
218 			goto bad;
219 		}
220 
221 		if (used_ebs != av->used_ebs) {
222 			ubi_err(ubi, "inconsistent used_ebs");
223 			goto bad;
224 		}
225 
226 		if (data_pad != av->data_pad) {
227 			ubi_err(ubi, "inconsistent data_pad");
228 			goto bad;
229 		}
230 	}
231 
232 	return 0;
233 
234 bad:
235 	ubi_err(ubi, "inconsistent VID header at PEB %d", pnum);
236 	ubi_dump_vid_hdr(vid_hdr);
237 	ubi_dump_av(av);
238 	return -EINVAL;
239 }
240 
241 /**
242  * add_volume - add volume to the attaching information.
243  * @ai: attaching information
244  * @vol_id: ID of the volume to add
245  * @pnum: physical eraseblock number
246  * @vid_hdr: volume identifier header
247  *
248  * If the volume corresponding to the @vid_hdr logical eraseblock is already
249  * present in the attaching information, this function does nothing. Otherwise
250  * it adds corresponding volume to the attaching information. Returns a pointer
251  * to the allocated "av" object in case of success and a negative error code in
252  * case of failure.
253  */
254 static struct ubi_ainf_volume *add_volume(struct ubi_attach_info *ai,
255 					  int vol_id, int pnum,
256 					  const struct ubi_vid_hdr *vid_hdr)
257 {
258 	struct ubi_ainf_volume *av;
259 	struct rb_node **p = &ai->volumes.rb_node, *parent = NULL;
260 
261 	ubi_assert(vol_id == be32_to_cpu(vid_hdr->vol_id));
262 
263 	/* Walk the volume RB-tree to look if this volume is already present */
264 	while (*p) {
265 		parent = *p;
266 		av = rb_entry(parent, struct ubi_ainf_volume, rb);
267 
268 		if (vol_id == av->vol_id)
269 			return av;
270 
271 		if (vol_id > av->vol_id)
272 			p = &(*p)->rb_left;
273 		else
274 			p = &(*p)->rb_right;
275 	}
276 
277 	/* The volume is absent - add it */
278 	av = kmalloc(sizeof(struct ubi_ainf_volume), GFP_KERNEL);
279 	if (!av)
280 		return ERR_PTR(-ENOMEM);
281 
282 	av->highest_lnum = av->leb_count = 0;
283 	av->vol_id = vol_id;
284 	av->root = RB_ROOT;
285 	av->used_ebs = be32_to_cpu(vid_hdr->used_ebs);
286 	av->data_pad = be32_to_cpu(vid_hdr->data_pad);
287 	av->compat = vid_hdr->compat;
288 	av->vol_type = vid_hdr->vol_type == UBI_VID_DYNAMIC ? UBI_DYNAMIC_VOLUME
289 							    : UBI_STATIC_VOLUME;
290 	if (vol_id > ai->highest_vol_id)
291 		ai->highest_vol_id = vol_id;
292 
293 	rb_link_node(&av->rb, parent, p);
294 	rb_insert_color(&av->rb, &ai->volumes);
295 	ai->vols_found += 1;
296 	dbg_bld("added volume %d", vol_id);
297 	return av;
298 }
299 
300 /**
301  * ubi_compare_lebs - find out which logical eraseblock is newer.
302  * @ubi: UBI device description object
303  * @aeb: first logical eraseblock to compare
304  * @pnum: physical eraseblock number of the second logical eraseblock to
305  * compare
306  * @vid_hdr: volume identifier header of the second logical eraseblock
307  *
308  * This function compares 2 copies of a LEB and informs which one is newer. In
309  * case of success this function returns a positive value, in case of failure, a
310  * negative error code is returned. The success return codes use the following
311  * bits:
312  *     o bit 0 is cleared: the first PEB (described by @aeb) is newer than the
313  *       second PEB (described by @pnum and @vid_hdr);
314  *     o bit 0 is set: the second PEB is newer;
315  *     o bit 1 is cleared: no bit-flips were detected in the newer LEB;
316  *     o bit 1 is set: bit-flips were detected in the newer LEB;
317  *     o bit 2 is cleared: the older LEB is not corrupted;
318  *     o bit 2 is set: the older LEB is corrupted.
319  */
320 int ubi_compare_lebs(struct ubi_device *ubi, const struct ubi_ainf_peb *aeb,
321 			int pnum, const struct ubi_vid_hdr *vid_hdr)
322 {
323 	int len, err, second_is_newer, bitflips = 0, corrupted = 0;
324 	uint32_t data_crc, crc;
325 	struct ubi_vid_hdr *vh = NULL;
326 	unsigned long long sqnum2 = be64_to_cpu(vid_hdr->sqnum);
327 
328 	if (sqnum2 == aeb->sqnum) {
329 		/*
330 		 * This must be a really ancient UBI image which has been
331 		 * created before sequence numbers support has been added. At
332 		 * that times we used 32-bit LEB versions stored in logical
333 		 * eraseblocks. That was before UBI got into mainline. We do not
334 		 * support these images anymore. Well, those images still work,
335 		 * but only if no unclean reboots happened.
336 		 */
337 		ubi_err(ubi, "unsupported on-flash UBI format");
338 		return -EINVAL;
339 	}
340 
341 	/* Obviously the LEB with lower sequence counter is older */
342 	second_is_newer = (sqnum2 > aeb->sqnum);
343 
344 	/*
345 	 * Now we know which copy is newer. If the copy flag of the PEB with
346 	 * newer version is not set, then we just return, otherwise we have to
347 	 * check data CRC. For the second PEB we already have the VID header,
348 	 * for the first one - we'll need to re-read it from flash.
349 	 *
350 	 * Note: this may be optimized so that we wouldn't read twice.
351 	 */
352 
353 	if (second_is_newer) {
354 		if (!vid_hdr->copy_flag) {
355 			/* It is not a copy, so it is newer */
356 			dbg_bld("second PEB %d is newer, copy_flag is unset",
357 				pnum);
358 			return 1;
359 		}
360 	} else {
361 		if (!aeb->copy_flag) {
362 			/* It is not a copy, so it is newer */
363 			dbg_bld("first PEB %d is newer, copy_flag is unset",
364 				pnum);
365 			return bitflips << 1;
366 		}
367 
368 		vh = ubi_zalloc_vid_hdr(ubi, GFP_KERNEL);
369 		if (!vh)
370 			return -ENOMEM;
371 
372 		pnum = aeb->pnum;
373 		err = ubi_io_read_vid_hdr(ubi, pnum, vh, 0);
374 		if (err) {
375 			if (err == UBI_IO_BITFLIPS)
376 				bitflips = 1;
377 			else {
378 				ubi_err(ubi, "VID of PEB %d header is bad, but it was OK earlier, err %d",
379 					pnum, err);
380 				if (err > 0)
381 					err = -EIO;
382 
383 				goto out_free_vidh;
384 			}
385 		}
386 
387 		vid_hdr = vh;
388 	}
389 
390 	/* Read the data of the copy and check the CRC */
391 
392 	len = be32_to_cpu(vid_hdr->data_size);
393 
394 	mutex_lock(&ubi->buf_mutex);
395 	err = ubi_io_read_data(ubi, ubi->peb_buf, pnum, 0, len);
396 	if (err && err != UBI_IO_BITFLIPS && !mtd_is_eccerr(err))
397 		goto out_unlock;
398 
399 	data_crc = be32_to_cpu(vid_hdr->data_crc);
400 	crc = crc32(UBI_CRC32_INIT, ubi->peb_buf, len);
401 	if (crc != data_crc) {
402 		dbg_bld("PEB %d CRC error: calculated %#08x, must be %#08x",
403 			pnum, crc, data_crc);
404 		corrupted = 1;
405 		bitflips = 0;
406 		second_is_newer = !second_is_newer;
407 	} else {
408 		dbg_bld("PEB %d CRC is OK", pnum);
409 		bitflips |= !!err;
410 	}
411 	mutex_unlock(&ubi->buf_mutex);
412 
413 	ubi_free_vid_hdr(ubi, vh);
414 
415 	if (second_is_newer)
416 		dbg_bld("second PEB %d is newer, copy_flag is set", pnum);
417 	else
418 		dbg_bld("first PEB %d is newer, copy_flag is set", pnum);
419 
420 	return second_is_newer | (bitflips << 1) | (corrupted << 2);
421 
422 out_unlock:
423 	mutex_unlock(&ubi->buf_mutex);
424 out_free_vidh:
425 	ubi_free_vid_hdr(ubi, vh);
426 	return err;
427 }
428 
429 /**
430  * ubi_add_to_av - add used physical eraseblock to the attaching information.
431  * @ubi: UBI device description object
432  * @ai: attaching information
433  * @pnum: the physical eraseblock number
434  * @ec: erase counter
435  * @vid_hdr: the volume identifier header
436  * @bitflips: if bit-flips were detected when this physical eraseblock was read
437  *
438  * This function adds information about a used physical eraseblock to the
439  * 'used' tree of the corresponding volume. The function is rather complex
440  * because it has to handle cases when this is not the first physical
441  * eraseblock belonging to the same logical eraseblock, and the newer one has
442  * to be picked, while the older one has to be dropped. This function returns
443  * zero in case of success and a negative error code in case of failure.
444  */
445 int ubi_add_to_av(struct ubi_device *ubi, struct ubi_attach_info *ai, int pnum,
446 		  int ec, const struct ubi_vid_hdr *vid_hdr, int bitflips)
447 {
448 	int err, vol_id, lnum;
449 	unsigned long long sqnum;
450 	struct ubi_ainf_volume *av;
451 	struct ubi_ainf_peb *aeb;
452 	struct rb_node **p, *parent = NULL;
453 
454 	vol_id = be32_to_cpu(vid_hdr->vol_id);
455 	lnum = be32_to_cpu(vid_hdr->lnum);
456 	sqnum = be64_to_cpu(vid_hdr->sqnum);
457 
458 	dbg_bld("PEB %d, LEB %d:%d, EC %d, sqnum %llu, bitflips %d",
459 		pnum, vol_id, lnum, ec, sqnum, bitflips);
460 
461 	av = add_volume(ai, vol_id, pnum, vid_hdr);
462 	if (IS_ERR(av))
463 		return PTR_ERR(av);
464 
465 	if (ai->max_sqnum < sqnum)
466 		ai->max_sqnum = sqnum;
467 
468 	/*
469 	 * Walk the RB-tree of logical eraseblocks of volume @vol_id to look
470 	 * if this is the first instance of this logical eraseblock or not.
471 	 */
472 	p = &av->root.rb_node;
473 	while (*p) {
474 		int cmp_res;
475 
476 		parent = *p;
477 		aeb = rb_entry(parent, struct ubi_ainf_peb, u.rb);
478 		if (lnum != aeb->lnum) {
479 			if (lnum < aeb->lnum)
480 				p = &(*p)->rb_left;
481 			else
482 				p = &(*p)->rb_right;
483 			continue;
484 		}
485 
486 		/*
487 		 * There is already a physical eraseblock describing the same
488 		 * logical eraseblock present.
489 		 */
490 
491 		dbg_bld("this LEB already exists: PEB %d, sqnum %llu, EC %d",
492 			aeb->pnum, aeb->sqnum, aeb->ec);
493 
494 		/*
495 		 * Make sure that the logical eraseblocks have different
496 		 * sequence numbers. Otherwise the image is bad.
497 		 *
498 		 * However, if the sequence number is zero, we assume it must
499 		 * be an ancient UBI image from the era when UBI did not have
500 		 * sequence numbers. We still can attach these images, unless
501 		 * there is a need to distinguish between old and new
502 		 * eraseblocks, in which case we'll refuse the image in
503 		 * 'ubi_compare_lebs()'. In other words, we attach old clean
504 		 * images, but refuse attaching old images with duplicated
505 		 * logical eraseblocks because there was an unclean reboot.
506 		 */
507 		if (aeb->sqnum == sqnum && sqnum != 0) {
508 			ubi_err(ubi, "two LEBs with same sequence number %llu",
509 				sqnum);
510 			ubi_dump_aeb(aeb, 0);
511 			ubi_dump_vid_hdr(vid_hdr);
512 			return -EINVAL;
513 		}
514 
515 		/*
516 		 * Now we have to drop the older one and preserve the newer
517 		 * one.
518 		 */
519 		cmp_res = ubi_compare_lebs(ubi, aeb, pnum, vid_hdr);
520 		if (cmp_res < 0)
521 			return cmp_res;
522 
523 		if (cmp_res & 1) {
524 			/*
525 			 * This logical eraseblock is newer than the one
526 			 * found earlier.
527 			 */
528 			err = validate_vid_hdr(ubi, vid_hdr, av, pnum);
529 			if (err)
530 				return err;
531 
532 			err = add_to_list(ai, aeb->pnum, aeb->vol_id,
533 					  aeb->lnum, aeb->ec, cmp_res & 4,
534 					  &ai->erase);
535 			if (err)
536 				return err;
537 
538 			aeb->ec = ec;
539 			aeb->pnum = pnum;
540 			aeb->vol_id = vol_id;
541 			aeb->lnum = lnum;
542 			aeb->scrub = ((cmp_res & 2) || bitflips);
543 			aeb->copy_flag = vid_hdr->copy_flag;
544 			aeb->sqnum = sqnum;
545 
546 			if (av->highest_lnum == lnum)
547 				av->last_data_size =
548 					be32_to_cpu(vid_hdr->data_size);
549 
550 			return 0;
551 		} else {
552 			/*
553 			 * This logical eraseblock is older than the one found
554 			 * previously.
555 			 */
556 			return add_to_list(ai, pnum, vol_id, lnum, ec,
557 					   cmp_res & 4, &ai->erase);
558 		}
559 	}
560 
561 	/*
562 	 * We've met this logical eraseblock for the first time, add it to the
563 	 * attaching information.
564 	 */
565 
566 	err = validate_vid_hdr(ubi, vid_hdr, av, pnum);
567 	if (err)
568 		return err;
569 
570 	aeb = kmem_cache_alloc(ai->aeb_slab_cache, GFP_KERNEL);
571 	if (!aeb)
572 		return -ENOMEM;
573 
574 	aeb->ec = ec;
575 	aeb->pnum = pnum;
576 	aeb->vol_id = vol_id;
577 	aeb->lnum = lnum;
578 	aeb->scrub = bitflips;
579 	aeb->copy_flag = vid_hdr->copy_flag;
580 	aeb->sqnum = sqnum;
581 
582 	if (av->highest_lnum <= lnum) {
583 		av->highest_lnum = lnum;
584 		av->last_data_size = be32_to_cpu(vid_hdr->data_size);
585 	}
586 
587 	av->leb_count += 1;
588 	rb_link_node(&aeb->u.rb, parent, p);
589 	rb_insert_color(&aeb->u.rb, &av->root);
590 	return 0;
591 }
592 
593 /**
594  * ubi_find_av - find volume in the attaching information.
595  * @ai: attaching information
596  * @vol_id: the requested volume ID
597  *
598  * This function returns a pointer to the volume description or %NULL if there
599  * are no data about this volume in the attaching information.
600  */
601 struct ubi_ainf_volume *ubi_find_av(const struct ubi_attach_info *ai,
602 				    int vol_id)
603 {
604 	struct ubi_ainf_volume *av;
605 	struct rb_node *p = ai->volumes.rb_node;
606 
607 	while (p) {
608 		av = rb_entry(p, struct ubi_ainf_volume, rb);
609 
610 		if (vol_id == av->vol_id)
611 			return av;
612 
613 		if (vol_id > av->vol_id)
614 			p = p->rb_left;
615 		else
616 			p = p->rb_right;
617 	}
618 
619 	return NULL;
620 }
621 
622 /**
623  * ubi_remove_av - delete attaching information about a volume.
624  * @ai: attaching information
625  * @av: the volume attaching information to delete
626  */
627 void ubi_remove_av(struct ubi_attach_info *ai, struct ubi_ainf_volume *av)
628 {
629 	struct rb_node *rb;
630 	struct ubi_ainf_peb *aeb;
631 
632 	dbg_bld("remove attaching information about volume %d", av->vol_id);
633 
634 	while ((rb = rb_first(&av->root))) {
635 		aeb = rb_entry(rb, struct ubi_ainf_peb, u.rb);
636 		rb_erase(&aeb->u.rb, &av->root);
637 		list_add_tail(&aeb->u.list, &ai->erase);
638 	}
639 
640 	rb_erase(&av->rb, &ai->volumes);
641 	kfree(av);
642 	ai->vols_found -= 1;
643 }
644 
645 /**
646  * early_erase_peb - erase a physical eraseblock.
647  * @ubi: UBI device description object
648  * @ai: attaching information
649  * @pnum: physical eraseblock number to erase;
650  * @ec: erase counter value to write (%UBI_UNKNOWN if it is unknown)
651  *
652  * This function erases physical eraseblock 'pnum', and writes the erase
653  * counter header to it. This function should only be used on UBI device
654  * initialization stages, when the EBA sub-system had not been yet initialized.
655  * This function returns zero in case of success and a negative error code in
656  * case of failure.
657  */
658 static int early_erase_peb(struct ubi_device *ubi,
659 			   const struct ubi_attach_info *ai, int pnum, int ec)
660 {
661 	int err;
662 	struct ubi_ec_hdr *ec_hdr;
663 
664 	if ((long long)ec >= UBI_MAX_ERASECOUNTER) {
665 		/*
666 		 * Erase counter overflow. Upgrade UBI and use 64-bit
667 		 * erase counters internally.
668 		 */
669 		ubi_err(ubi, "erase counter overflow at PEB %d, EC %d",
670 			pnum, ec);
671 		return -EINVAL;
672 	}
673 
674 	ec_hdr = kzalloc(ubi->ec_hdr_alsize, GFP_KERNEL);
675 	if (!ec_hdr)
676 		return -ENOMEM;
677 
678 	ec_hdr->ec = cpu_to_be64(ec);
679 
680 	err = ubi_io_sync_erase(ubi, pnum, 0);
681 	if (err < 0)
682 		goto out_free;
683 
684 	err = ubi_io_write_ec_hdr(ubi, pnum, ec_hdr);
685 
686 out_free:
687 	kfree(ec_hdr);
688 	return err;
689 }
690 
691 /**
692  * ubi_early_get_peb - get a free physical eraseblock.
693  * @ubi: UBI device description object
694  * @ai: attaching information
695  *
696  * This function returns a free physical eraseblock. It is supposed to be
697  * called on the UBI initialization stages when the wear-leveling sub-system is
698  * not initialized yet. This function picks a physical eraseblocks from one of
699  * the lists, writes the EC header if it is needed, and removes it from the
700  * list.
701  *
702  * This function returns a pointer to the "aeb" of the found free PEB in case
703  * of success and an error code in case of failure.
704  */
705 struct ubi_ainf_peb *ubi_early_get_peb(struct ubi_device *ubi,
706 				       struct ubi_attach_info *ai)
707 {
708 	int err = 0;
709 	struct ubi_ainf_peb *aeb, *tmp_aeb;
710 
711 	if (!list_empty(&ai->free)) {
712 		aeb = list_entry(ai->free.next, struct ubi_ainf_peb, u.list);
713 		list_del(&aeb->u.list);
714 		dbg_bld("return free PEB %d, EC %d", aeb->pnum, aeb->ec);
715 		return aeb;
716 	}
717 
718 	/*
719 	 * We try to erase the first physical eraseblock from the erase list
720 	 * and pick it if we succeed, or try to erase the next one if not. And
721 	 * so forth. We don't want to take care about bad eraseblocks here -
722 	 * they'll be handled later.
723 	 */
724 	list_for_each_entry_safe(aeb, tmp_aeb, &ai->erase, u.list) {
725 		if (aeb->ec == UBI_UNKNOWN)
726 			aeb->ec = ai->mean_ec;
727 
728 		err = early_erase_peb(ubi, ai, aeb->pnum, aeb->ec+1);
729 		if (err)
730 			continue;
731 
732 		aeb->ec += 1;
733 		list_del(&aeb->u.list);
734 		dbg_bld("return PEB %d, EC %d", aeb->pnum, aeb->ec);
735 		return aeb;
736 	}
737 
738 	ubi_err(ubi, "no free eraseblocks");
739 	return ERR_PTR(-ENOSPC);
740 }
741 
742 /**
743  * check_corruption - check the data area of PEB.
744  * @ubi: UBI device description object
745  * @vid_hdr: the (corrupted) VID header of this PEB
746  * @pnum: the physical eraseblock number to check
747  *
748  * This is a helper function which is used to distinguish between VID header
749  * corruptions caused by power cuts and other reasons. If the PEB contains only
750  * 0xFF bytes in the data area, the VID header is most probably corrupted
751  * because of a power cut (%0 is returned in this case). Otherwise, it was
752  * probably corrupted for some other reasons (%1 is returned in this case). A
753  * negative error code is returned if a read error occurred.
754  *
755  * If the corruption reason was a power cut, UBI can safely erase this PEB.
756  * Otherwise, it should preserve it to avoid possibly destroying important
757  * information.
758  */
759 static int check_corruption(struct ubi_device *ubi, struct ubi_vid_hdr *vid_hdr,
760 			    int pnum)
761 {
762 	int err;
763 
764 	mutex_lock(&ubi->buf_mutex);
765 	memset(ubi->peb_buf, 0x00, ubi->leb_size);
766 
767 	err = ubi_io_read(ubi, ubi->peb_buf, pnum, ubi->leb_start,
768 			  ubi->leb_size);
769 	if (err == UBI_IO_BITFLIPS || mtd_is_eccerr(err)) {
770 		/*
771 		 * Bit-flips or integrity errors while reading the data area.
772 		 * It is difficult to say for sure what type of corruption is
773 		 * this, but presumably a power cut happened while this PEB was
774 		 * erased, so it became unstable and corrupted, and should be
775 		 * erased.
776 		 */
777 		err = 0;
778 		goto out_unlock;
779 	}
780 
781 	if (err)
782 		goto out_unlock;
783 
784 	if (ubi_check_pattern(ubi->peb_buf, 0xFF, ubi->leb_size))
785 		goto out_unlock;
786 
787 	ubi_err(ubi, "PEB %d contains corrupted VID header, and the data does not contain all 0xFF",
788 		pnum);
789 	ubi_err(ubi, "this may be a non-UBI PEB or a severe VID header corruption which requires manual inspection");
790 	ubi_dump_vid_hdr(vid_hdr);
791 	pr_err("hexdump of PEB %d offset %d, length %d",
792 	       pnum, ubi->leb_start, ubi->leb_size);
793 	ubi_dbg_print_hex_dump(KERN_DEBUG, "", DUMP_PREFIX_OFFSET, 32, 1,
794 			       ubi->peb_buf, ubi->leb_size, 1);
795 	err = 1;
796 
797 out_unlock:
798 	mutex_unlock(&ubi->buf_mutex);
799 	return err;
800 }
801 
802 /**
803  * scan_peb - scan and process UBI headers of a PEB.
804  * @ubi: UBI device description object
805  * @ai: attaching information
806  * @pnum: the physical eraseblock number
807  * @vid: The volume ID of the found volume will be stored in this pointer
808  * @sqnum: The sqnum of the found volume will be stored in this pointer
809  *
810  * This function reads UBI headers of PEB @pnum, checks them, and adds
811  * information about this PEB to the corresponding list or RB-tree in the
812  * "attaching info" structure. Returns zero if the physical eraseblock was
813  * successfully handled and a negative error code in case of failure.
814  */
815 static int scan_peb(struct ubi_device *ubi, struct ubi_attach_info *ai,
816 		    int pnum, int *vid, unsigned long long *sqnum)
817 {
818 	long long uninitialized_var(ec);
819 	int err, bitflips = 0, vol_id = -1, ec_err = 0;
820 
821 	dbg_bld("scan PEB %d", pnum);
822 
823 	/* Skip bad physical eraseblocks */
824 	err = ubi_io_is_bad(ubi, pnum);
825 	if (err < 0)
826 		return err;
827 	else if (err) {
828 		ai->bad_peb_count += 1;
829 		return 0;
830 	}
831 
832 	err = ubi_io_read_ec_hdr(ubi, pnum, ech, 0);
833 	if (err < 0)
834 		return err;
835 	switch (err) {
836 	case 0:
837 		break;
838 	case UBI_IO_BITFLIPS:
839 		bitflips = 1;
840 		break;
841 	case UBI_IO_FF:
842 		ai->empty_peb_count += 1;
843 		return add_to_list(ai, pnum, UBI_UNKNOWN, UBI_UNKNOWN,
844 				   UBI_UNKNOWN, 0, &ai->erase);
845 	case UBI_IO_FF_BITFLIPS:
846 		ai->empty_peb_count += 1;
847 		return add_to_list(ai, pnum, UBI_UNKNOWN, UBI_UNKNOWN,
848 				   UBI_UNKNOWN, 1, &ai->erase);
849 	case UBI_IO_BAD_HDR_EBADMSG:
850 	case UBI_IO_BAD_HDR:
851 		/*
852 		 * We have to also look at the VID header, possibly it is not
853 		 * corrupted. Set %bitflips flag in order to make this PEB be
854 		 * moved and EC be re-created.
855 		 */
856 		ec_err = err;
857 		ec = UBI_UNKNOWN;
858 		bitflips = 1;
859 		break;
860 	default:
861 		ubi_err(ubi, "'ubi_io_read_ec_hdr()' returned unknown code %d",
862 			err);
863 		return -EINVAL;
864 	}
865 
866 	if (!ec_err) {
867 		int image_seq;
868 
869 		/* Make sure UBI version is OK */
870 		if (ech->version != UBI_VERSION) {
871 			ubi_err(ubi, "this UBI version is %d, image version is %d",
872 				UBI_VERSION, (int)ech->version);
873 			return -EINVAL;
874 		}
875 
876 		ec = be64_to_cpu(ech->ec);
877 		if (ec > UBI_MAX_ERASECOUNTER) {
878 			/*
879 			 * Erase counter overflow. The EC headers have 64 bits
880 			 * reserved, but we anyway make use of only 31 bit
881 			 * values, as this seems to be enough for any existing
882 			 * flash. Upgrade UBI and use 64-bit erase counters
883 			 * internally.
884 			 */
885 			ubi_err(ubi, "erase counter overflow, max is %d",
886 				UBI_MAX_ERASECOUNTER);
887 			ubi_dump_ec_hdr(ech);
888 			return -EINVAL;
889 		}
890 
891 		/*
892 		 * Make sure that all PEBs have the same image sequence number.
893 		 * This allows us to detect situations when users flash UBI
894 		 * images incorrectly, so that the flash has the new UBI image
895 		 * and leftovers from the old one. This feature was added
896 		 * relatively recently, and the sequence number was always
897 		 * zero, because old UBI implementations always set it to zero.
898 		 * For this reasons, we do not panic if some PEBs have zero
899 		 * sequence number, while other PEBs have non-zero sequence
900 		 * number.
901 		 */
902 		image_seq = be32_to_cpu(ech->image_seq);
903 		if (!ubi->image_seq)
904 			ubi->image_seq = image_seq;
905 		if (image_seq && ubi->image_seq != image_seq) {
906 			ubi_err(ubi, "bad image sequence number %d in PEB %d, expected %d",
907 				image_seq, pnum, ubi->image_seq);
908 			ubi_dump_ec_hdr(ech);
909 			return -EINVAL;
910 		}
911 	}
912 
913 	/* OK, we've done with the EC header, let's look at the VID header */
914 
915 	err = ubi_io_read_vid_hdr(ubi, pnum, vidh, 0);
916 	if (err < 0)
917 		return err;
918 	switch (err) {
919 	case 0:
920 		break;
921 	case UBI_IO_BITFLIPS:
922 		bitflips = 1;
923 		break;
924 	case UBI_IO_BAD_HDR_EBADMSG:
925 		if (ec_err == UBI_IO_BAD_HDR_EBADMSG)
926 			/*
927 			 * Both EC and VID headers are corrupted and were read
928 			 * with data integrity error, probably this is a bad
929 			 * PEB, bit it is not marked as bad yet. This may also
930 			 * be a result of power cut during erasure.
931 			 */
932 			ai->maybe_bad_peb_count += 1;
933 	case UBI_IO_BAD_HDR:
934 		if (ec_err)
935 			/*
936 			 * Both headers are corrupted. There is a possibility
937 			 * that this a valid UBI PEB which has corresponding
938 			 * LEB, but the headers are corrupted. However, it is
939 			 * impossible to distinguish it from a PEB which just
940 			 * contains garbage because of a power cut during erase
941 			 * operation. So we just schedule this PEB for erasure.
942 			 *
943 			 * Besides, in case of NOR flash, we deliberately
944 			 * corrupt both headers because NOR flash erasure is
945 			 * slow and can start from the end.
946 			 */
947 			err = 0;
948 		else
949 			/*
950 			 * The EC was OK, but the VID header is corrupted. We
951 			 * have to check what is in the data area.
952 			 */
953 			err = check_corruption(ubi, vidh, pnum);
954 
955 		if (err < 0)
956 			return err;
957 		else if (!err)
958 			/* This corruption is caused by a power cut */
959 			err = add_to_list(ai, pnum, UBI_UNKNOWN,
960 					  UBI_UNKNOWN, ec, 1, &ai->erase);
961 		else
962 			/* This is an unexpected corruption */
963 			err = add_corrupted(ai, pnum, ec);
964 		if (err)
965 			return err;
966 		goto adjust_mean_ec;
967 	case UBI_IO_FF_BITFLIPS:
968 		err = add_to_list(ai, pnum, UBI_UNKNOWN, UBI_UNKNOWN,
969 				  ec, 1, &ai->erase);
970 		if (err)
971 			return err;
972 		goto adjust_mean_ec;
973 	case UBI_IO_FF:
974 		if (ec_err || bitflips)
975 			err = add_to_list(ai, pnum, UBI_UNKNOWN,
976 					  UBI_UNKNOWN, ec, 1, &ai->erase);
977 		else
978 			err = add_to_list(ai, pnum, UBI_UNKNOWN,
979 					  UBI_UNKNOWN, ec, 0, &ai->free);
980 		if (err)
981 			return err;
982 		goto adjust_mean_ec;
983 	default:
984 		ubi_err(ubi, "'ubi_io_read_vid_hdr()' returned unknown code %d",
985 			err);
986 		return -EINVAL;
987 	}
988 
989 	vol_id = be32_to_cpu(vidh->vol_id);
990 	if (vid)
991 		*vid = vol_id;
992 	if (sqnum)
993 		*sqnum = be64_to_cpu(vidh->sqnum);
994 	if (vol_id > UBI_MAX_VOLUMES && vol_id != UBI_LAYOUT_VOLUME_ID) {
995 		int lnum = be32_to_cpu(vidh->lnum);
996 
997 		/* Unsupported internal volume */
998 		switch (vidh->compat) {
999 		case UBI_COMPAT_DELETE:
1000 			if (vol_id != UBI_FM_SB_VOLUME_ID
1001 			    && vol_id != UBI_FM_DATA_VOLUME_ID) {
1002 				ubi_msg(ubi, "\"delete\" compatible internal volume %d:%d found, will remove it",
1003 					vol_id, lnum);
1004 			}
1005 			err = add_to_list(ai, pnum, vol_id, lnum,
1006 					  ec, 1, &ai->erase);
1007 			if (err)
1008 				return err;
1009 			return 0;
1010 
1011 		case UBI_COMPAT_RO:
1012 			ubi_msg(ubi, "read-only compatible internal volume %d:%d found, switch to read-only mode",
1013 				vol_id, lnum);
1014 			ubi->ro_mode = 1;
1015 			break;
1016 
1017 		case UBI_COMPAT_PRESERVE:
1018 			ubi_msg(ubi, "\"preserve\" compatible internal volume %d:%d found",
1019 				vol_id, lnum);
1020 			err = add_to_list(ai, pnum, vol_id, lnum,
1021 					  ec, 0, &ai->alien);
1022 			if (err)
1023 				return err;
1024 			return 0;
1025 
1026 		case UBI_COMPAT_REJECT:
1027 			ubi_err(ubi, "incompatible internal volume %d:%d found",
1028 				vol_id, lnum);
1029 			return -EINVAL;
1030 		}
1031 	}
1032 
1033 	if (ec_err)
1034 		ubi_warn(ubi, "valid VID header but corrupted EC header at PEB %d",
1035 			 pnum);
1036 	err = ubi_add_to_av(ubi, ai, pnum, ec, vidh, bitflips);
1037 	if (err)
1038 		return err;
1039 
1040 adjust_mean_ec:
1041 	if (!ec_err) {
1042 		ai->ec_sum += ec;
1043 		ai->ec_count += 1;
1044 		if (ec > ai->max_ec)
1045 			ai->max_ec = ec;
1046 		if (ec < ai->min_ec)
1047 			ai->min_ec = ec;
1048 	}
1049 
1050 	return 0;
1051 }
1052 
1053 /**
1054  * late_analysis - analyze the overall situation with PEB.
1055  * @ubi: UBI device description object
1056  * @ai: attaching information
1057  *
1058  * This is a helper function which takes a look what PEBs we have after we
1059  * gather information about all of them ("ai" is compete). It decides whether
1060  * the flash is empty and should be formatted of whether there are too many
1061  * corrupted PEBs and we should not attach this MTD device. Returns zero if we
1062  * should proceed with attaching the MTD device, and %-EINVAL if we should not.
1063  */
1064 static int late_analysis(struct ubi_device *ubi, struct ubi_attach_info *ai)
1065 {
1066 	struct ubi_ainf_peb *aeb;
1067 	int max_corr, peb_count;
1068 
1069 	peb_count = ubi->peb_count - ai->bad_peb_count - ai->alien_peb_count;
1070 	max_corr = peb_count / 20 ?: 8;
1071 
1072 	/*
1073 	 * Few corrupted PEBs is not a problem and may be just a result of
1074 	 * unclean reboots. However, many of them may indicate some problems
1075 	 * with the flash HW or driver.
1076 	 */
1077 	if (ai->corr_peb_count) {
1078 		ubi_err(ubi, "%d PEBs are corrupted and preserved",
1079 			ai->corr_peb_count);
1080 		pr_err("Corrupted PEBs are:");
1081 		list_for_each_entry(aeb, &ai->corr, u.list)
1082 			pr_cont(" %d", aeb->pnum);
1083 		pr_cont("\n");
1084 
1085 		/*
1086 		 * If too many PEBs are corrupted, we refuse attaching,
1087 		 * otherwise, only print a warning.
1088 		 */
1089 		if (ai->corr_peb_count >= max_corr) {
1090 			ubi_err(ubi, "too many corrupted PEBs, refusing");
1091 			return -EINVAL;
1092 		}
1093 	}
1094 
1095 	if (ai->empty_peb_count + ai->maybe_bad_peb_count == peb_count) {
1096 		/*
1097 		 * All PEBs are empty, or almost all - a couple PEBs look like
1098 		 * they may be bad PEBs which were not marked as bad yet.
1099 		 *
1100 		 * This piece of code basically tries to distinguish between
1101 		 * the following situations:
1102 		 *
1103 		 * 1. Flash is empty, but there are few bad PEBs, which are not
1104 		 *    marked as bad so far, and which were read with error. We
1105 		 *    want to go ahead and format this flash. While formatting,
1106 		 *    the faulty PEBs will probably be marked as bad.
1107 		 *
1108 		 * 2. Flash contains non-UBI data and we do not want to format
1109 		 *    it and destroy possibly important information.
1110 		 */
1111 		if (ai->maybe_bad_peb_count <= 2) {
1112 			ai->is_empty = 1;
1113 			ubi_msg(ubi, "empty MTD device detected");
1114 			get_random_bytes(&ubi->image_seq,
1115 					 sizeof(ubi->image_seq));
1116 		} else {
1117 			ubi_err(ubi, "MTD device is not UBI-formatted and possibly contains non-UBI data - refusing it");
1118 			return -EINVAL;
1119 		}
1120 
1121 	}
1122 
1123 	return 0;
1124 }
1125 
1126 /**
1127  * destroy_av - free volume attaching information.
1128  * @av: volume attaching information
1129  * @ai: attaching information
1130  *
1131  * This function destroys the volume attaching information.
1132  */
1133 static void destroy_av(struct ubi_attach_info *ai, struct ubi_ainf_volume *av)
1134 {
1135 	struct ubi_ainf_peb *aeb;
1136 	struct rb_node *this = av->root.rb_node;
1137 
1138 	while (this) {
1139 		if (this->rb_left)
1140 			this = this->rb_left;
1141 		else if (this->rb_right)
1142 			this = this->rb_right;
1143 		else {
1144 			aeb = rb_entry(this, struct ubi_ainf_peb, u.rb);
1145 			this = rb_parent(this);
1146 			if (this) {
1147 				if (this->rb_left == &aeb->u.rb)
1148 					this->rb_left = NULL;
1149 				else
1150 					this->rb_right = NULL;
1151 			}
1152 
1153 			kmem_cache_free(ai->aeb_slab_cache, aeb);
1154 		}
1155 	}
1156 	kfree(av);
1157 }
1158 
1159 /**
1160  * destroy_ai - destroy attaching information.
1161  * @ai: attaching information
1162  */
1163 static void destroy_ai(struct ubi_attach_info *ai)
1164 {
1165 	struct ubi_ainf_peb *aeb, *aeb_tmp;
1166 	struct ubi_ainf_volume *av;
1167 	struct rb_node *rb;
1168 
1169 	list_for_each_entry_safe(aeb, aeb_tmp, &ai->alien, u.list) {
1170 		list_del(&aeb->u.list);
1171 		kmem_cache_free(ai->aeb_slab_cache, aeb);
1172 	}
1173 	list_for_each_entry_safe(aeb, aeb_tmp, &ai->erase, u.list) {
1174 		list_del(&aeb->u.list);
1175 		kmem_cache_free(ai->aeb_slab_cache, aeb);
1176 	}
1177 	list_for_each_entry_safe(aeb, aeb_tmp, &ai->corr, u.list) {
1178 		list_del(&aeb->u.list);
1179 		kmem_cache_free(ai->aeb_slab_cache, aeb);
1180 	}
1181 	list_for_each_entry_safe(aeb, aeb_tmp, &ai->free, u.list) {
1182 		list_del(&aeb->u.list);
1183 		kmem_cache_free(ai->aeb_slab_cache, aeb);
1184 	}
1185 
1186 	/* Destroy the volume RB-tree */
1187 	rb = ai->volumes.rb_node;
1188 	while (rb) {
1189 		if (rb->rb_left)
1190 			rb = rb->rb_left;
1191 		else if (rb->rb_right)
1192 			rb = rb->rb_right;
1193 		else {
1194 			av = rb_entry(rb, struct ubi_ainf_volume, rb);
1195 
1196 			rb = rb_parent(rb);
1197 			if (rb) {
1198 				if (rb->rb_left == &av->rb)
1199 					rb->rb_left = NULL;
1200 				else
1201 					rb->rb_right = NULL;
1202 			}
1203 
1204 			destroy_av(ai, av);
1205 		}
1206 	}
1207 
1208 	if (ai->aeb_slab_cache)
1209 		kmem_cache_destroy(ai->aeb_slab_cache);
1210 
1211 	kfree(ai);
1212 }
1213 
1214 /**
1215  * scan_all - scan entire MTD device.
1216  * @ubi: UBI device description object
1217  * @ai: attach info object
1218  * @start: start scanning at this PEB
1219  *
1220  * This function does full scanning of an MTD device and returns complete
1221  * information about it in form of a "struct ubi_attach_info" object. In case
1222  * of failure, an error code is returned.
1223  */
1224 static int scan_all(struct ubi_device *ubi, struct ubi_attach_info *ai,
1225 		    int start)
1226 {
1227 	int err, pnum;
1228 	struct rb_node *rb1, *rb2;
1229 	struct ubi_ainf_volume *av;
1230 	struct ubi_ainf_peb *aeb;
1231 
1232 	err = -ENOMEM;
1233 
1234 	ech = kzalloc(ubi->ec_hdr_alsize, GFP_KERNEL);
1235 	if (!ech)
1236 		return err;
1237 
1238 	vidh = ubi_zalloc_vid_hdr(ubi, GFP_KERNEL);
1239 	if (!vidh)
1240 		goto out_ech;
1241 
1242 	for (pnum = start; pnum < ubi->peb_count; pnum++) {
1243 		cond_resched();
1244 
1245 		dbg_gen("process PEB %d", pnum);
1246 		err = scan_peb(ubi, ai, pnum, NULL, NULL);
1247 		if (err < 0)
1248 			goto out_vidh;
1249 	}
1250 
1251 	ubi_msg(ubi, "scanning is finished");
1252 
1253 	/* Calculate mean erase counter */
1254 	if (ai->ec_count)
1255 		ai->mean_ec = div_u64(ai->ec_sum, ai->ec_count);
1256 
1257 	err = late_analysis(ubi, ai);
1258 	if (err)
1259 		goto out_vidh;
1260 
1261 	/*
1262 	 * In case of unknown erase counter we use the mean erase counter
1263 	 * value.
1264 	 */
1265 	ubi_rb_for_each_entry(rb1, av, &ai->volumes, rb) {
1266 		ubi_rb_for_each_entry(rb2, aeb, &av->root, u.rb)
1267 			if (aeb->ec == UBI_UNKNOWN)
1268 				aeb->ec = ai->mean_ec;
1269 	}
1270 
1271 	list_for_each_entry(aeb, &ai->free, u.list) {
1272 		if (aeb->ec == UBI_UNKNOWN)
1273 			aeb->ec = ai->mean_ec;
1274 	}
1275 
1276 	list_for_each_entry(aeb, &ai->corr, u.list)
1277 		if (aeb->ec == UBI_UNKNOWN)
1278 			aeb->ec = ai->mean_ec;
1279 
1280 	list_for_each_entry(aeb, &ai->erase, u.list)
1281 		if (aeb->ec == UBI_UNKNOWN)
1282 			aeb->ec = ai->mean_ec;
1283 
1284 	err = self_check_ai(ubi, ai);
1285 	if (err)
1286 		goto out_vidh;
1287 
1288 	ubi_free_vid_hdr(ubi, vidh);
1289 	kfree(ech);
1290 
1291 	return 0;
1292 
1293 out_vidh:
1294 	ubi_free_vid_hdr(ubi, vidh);
1295 out_ech:
1296 	kfree(ech);
1297 	return err;
1298 }
1299 
1300 static struct ubi_attach_info *alloc_ai(void)
1301 {
1302 	struct ubi_attach_info *ai;
1303 
1304 	ai = kzalloc(sizeof(struct ubi_attach_info), GFP_KERNEL);
1305 	if (!ai)
1306 		return ai;
1307 
1308 	INIT_LIST_HEAD(&ai->corr);
1309 	INIT_LIST_HEAD(&ai->free);
1310 	INIT_LIST_HEAD(&ai->erase);
1311 	INIT_LIST_HEAD(&ai->alien);
1312 	ai->volumes = RB_ROOT;
1313 	ai->aeb_slab_cache = kmem_cache_create("ubi_aeb_slab_cache",
1314 					       sizeof(struct ubi_ainf_peb),
1315 					       0, 0, NULL);
1316 	if (!ai->aeb_slab_cache) {
1317 		kfree(ai);
1318 		ai = NULL;
1319 	}
1320 
1321 	return ai;
1322 }
1323 
1324 #ifdef CONFIG_MTD_UBI_FASTMAP
1325 
1326 /**
1327  * scan_fastmap - try to find a fastmap and attach from it.
1328  * @ubi: UBI device description object
1329  * @ai: attach info object
1330  *
1331  * Returns 0 on success, negative return values indicate an internal
1332  * error.
1333  * UBI_NO_FASTMAP denotes that no fastmap was found.
1334  * UBI_BAD_FASTMAP denotes that the found fastmap was invalid.
1335  */
1336 static int scan_fast(struct ubi_device *ubi, struct ubi_attach_info **ai)
1337 {
1338 	int err, pnum, fm_anchor = -1;
1339 	unsigned long long max_sqnum = 0;
1340 
1341 	err = -ENOMEM;
1342 
1343 	ech = kzalloc(ubi->ec_hdr_alsize, GFP_KERNEL);
1344 	if (!ech)
1345 		goto out;
1346 
1347 	vidh = ubi_zalloc_vid_hdr(ubi, GFP_KERNEL);
1348 	if (!vidh)
1349 		goto out_ech;
1350 
1351 	for (pnum = 0; pnum < UBI_FM_MAX_START; pnum++) {
1352 		int vol_id = -1;
1353 		unsigned long long sqnum = -1;
1354 		cond_resched();
1355 
1356 		dbg_gen("process PEB %d", pnum);
1357 		err = scan_peb(ubi, *ai, pnum, &vol_id, &sqnum);
1358 		if (err < 0)
1359 			goto out_vidh;
1360 
1361 		if (vol_id == UBI_FM_SB_VOLUME_ID && sqnum > max_sqnum) {
1362 			max_sqnum = sqnum;
1363 			fm_anchor = pnum;
1364 		}
1365 	}
1366 
1367 	ubi_free_vid_hdr(ubi, vidh);
1368 	kfree(ech);
1369 
1370 	if (fm_anchor < 0)
1371 		return UBI_NO_FASTMAP;
1372 
1373 	destroy_ai(*ai);
1374 	*ai = alloc_ai();
1375 	if (!*ai)
1376 		return -ENOMEM;
1377 
1378 	return ubi_scan_fastmap(ubi, *ai, fm_anchor);
1379 
1380 out_vidh:
1381 	ubi_free_vid_hdr(ubi, vidh);
1382 out_ech:
1383 	kfree(ech);
1384 out:
1385 	return err;
1386 }
1387 
1388 #endif
1389 
1390 /**
1391  * ubi_attach - attach an MTD device.
1392  * @ubi: UBI device descriptor
1393  * @force_scan: if set to non-zero attach by scanning
1394  *
1395  * This function returns zero in case of success and a negative error code in
1396  * case of failure.
1397  */
1398 int ubi_attach(struct ubi_device *ubi, int force_scan)
1399 {
1400 	int err;
1401 	struct ubi_attach_info *ai;
1402 
1403 	ai = alloc_ai();
1404 	if (!ai)
1405 		return -ENOMEM;
1406 
1407 #ifdef CONFIG_MTD_UBI_FASTMAP
1408 	/* On small flash devices we disable fastmap in any case. */
1409 	if ((int)mtd_div_by_eb(ubi->mtd->size, ubi->mtd) <= UBI_FM_MAX_START) {
1410 		ubi->fm_disabled = 1;
1411 		force_scan = 1;
1412 	}
1413 
1414 	if (force_scan)
1415 		err = scan_all(ubi, ai, 0);
1416 	else {
1417 		err = scan_fast(ubi, &ai);
1418 		if (err > 0 || mtd_is_eccerr(err)) {
1419 			if (err != UBI_NO_FASTMAP) {
1420 				destroy_ai(ai);
1421 				ai = alloc_ai();
1422 				if (!ai)
1423 					return -ENOMEM;
1424 
1425 				err = scan_all(ubi, ai, 0);
1426 			} else {
1427 				err = scan_all(ubi, ai, UBI_FM_MAX_START);
1428 			}
1429 		}
1430 	}
1431 #else
1432 	err = scan_all(ubi, ai, 0);
1433 #endif
1434 	if (err)
1435 		goto out_ai;
1436 
1437 	ubi->bad_peb_count = ai->bad_peb_count;
1438 	ubi->good_peb_count = ubi->peb_count - ubi->bad_peb_count;
1439 	ubi->corr_peb_count = ai->corr_peb_count;
1440 	ubi->max_ec = ai->max_ec;
1441 	ubi->mean_ec = ai->mean_ec;
1442 	dbg_gen("max. sequence number:       %llu", ai->max_sqnum);
1443 
1444 	err = ubi_read_volume_table(ubi, ai);
1445 	if (err)
1446 		goto out_ai;
1447 
1448 	err = ubi_wl_init(ubi, ai);
1449 	if (err)
1450 		goto out_vtbl;
1451 
1452 	err = ubi_eba_init(ubi, ai);
1453 	if (err)
1454 		goto out_wl;
1455 
1456 #ifdef CONFIG_MTD_UBI_FASTMAP
1457 	if (ubi->fm && ubi_dbg_chk_fastmap(ubi)) {
1458 		struct ubi_attach_info *scan_ai;
1459 
1460 		scan_ai = alloc_ai();
1461 		if (!scan_ai) {
1462 			err = -ENOMEM;
1463 			goto out_wl;
1464 		}
1465 
1466 		err = scan_all(ubi, scan_ai, 0);
1467 		if (err) {
1468 			destroy_ai(scan_ai);
1469 			goto out_wl;
1470 		}
1471 
1472 		err = self_check_eba(ubi, ai, scan_ai);
1473 		destroy_ai(scan_ai);
1474 
1475 		if (err)
1476 			goto out_wl;
1477 	}
1478 #endif
1479 
1480 	destroy_ai(ai);
1481 	return 0;
1482 
1483 out_wl:
1484 	ubi_wl_close(ubi);
1485 out_vtbl:
1486 	ubi_free_internal_volumes(ubi);
1487 	vfree(ubi->vtbl);
1488 out_ai:
1489 	destroy_ai(ai);
1490 	return err;
1491 }
1492 
1493 /**
1494  * self_check_ai - check the attaching information.
1495  * @ubi: UBI device description object
1496  * @ai: attaching information
1497  *
1498  * This function returns zero if the attaching information is all right, and a
1499  * negative error code if not or if an error occurred.
1500  */
1501 static int self_check_ai(struct ubi_device *ubi, struct ubi_attach_info *ai)
1502 {
1503 	int pnum, err, vols_found = 0;
1504 	struct rb_node *rb1, *rb2;
1505 	struct ubi_ainf_volume *av;
1506 	struct ubi_ainf_peb *aeb, *last_aeb;
1507 	uint8_t *buf;
1508 
1509 	if (!ubi_dbg_chk_gen(ubi))
1510 		return 0;
1511 
1512 	/*
1513 	 * At first, check that attaching information is OK.
1514 	 */
1515 	ubi_rb_for_each_entry(rb1, av, &ai->volumes, rb) {
1516 		int leb_count = 0;
1517 
1518 		cond_resched();
1519 
1520 		vols_found += 1;
1521 
1522 		if (ai->is_empty) {
1523 			ubi_err(ubi, "bad is_empty flag");
1524 			goto bad_av;
1525 		}
1526 
1527 		if (av->vol_id < 0 || av->highest_lnum < 0 ||
1528 		    av->leb_count < 0 || av->vol_type < 0 || av->used_ebs < 0 ||
1529 		    av->data_pad < 0 || av->last_data_size < 0) {
1530 			ubi_err(ubi, "negative values");
1531 			goto bad_av;
1532 		}
1533 
1534 		if (av->vol_id >= UBI_MAX_VOLUMES &&
1535 		    av->vol_id < UBI_INTERNAL_VOL_START) {
1536 			ubi_err(ubi, "bad vol_id");
1537 			goto bad_av;
1538 		}
1539 
1540 		if (av->vol_id > ai->highest_vol_id) {
1541 			ubi_err(ubi, "highest_vol_id is %d, but vol_id %d is there",
1542 				ai->highest_vol_id, av->vol_id);
1543 			goto out;
1544 		}
1545 
1546 		if (av->vol_type != UBI_DYNAMIC_VOLUME &&
1547 		    av->vol_type != UBI_STATIC_VOLUME) {
1548 			ubi_err(ubi, "bad vol_type");
1549 			goto bad_av;
1550 		}
1551 
1552 		if (av->data_pad > ubi->leb_size / 2) {
1553 			ubi_err(ubi, "bad data_pad");
1554 			goto bad_av;
1555 		}
1556 
1557 		last_aeb = NULL;
1558 		ubi_rb_for_each_entry(rb2, aeb, &av->root, u.rb) {
1559 			cond_resched();
1560 
1561 			last_aeb = aeb;
1562 			leb_count += 1;
1563 
1564 			if (aeb->pnum < 0 || aeb->ec < 0) {
1565 				ubi_err(ubi, "negative values");
1566 				goto bad_aeb;
1567 			}
1568 
1569 			if (aeb->ec < ai->min_ec) {
1570 				ubi_err(ubi, "bad ai->min_ec (%d), %d found",
1571 					ai->min_ec, aeb->ec);
1572 				goto bad_aeb;
1573 			}
1574 
1575 			if (aeb->ec > ai->max_ec) {
1576 				ubi_err(ubi, "bad ai->max_ec (%d), %d found",
1577 					ai->max_ec, aeb->ec);
1578 				goto bad_aeb;
1579 			}
1580 
1581 			if (aeb->pnum >= ubi->peb_count) {
1582 				ubi_err(ubi, "too high PEB number %d, total PEBs %d",
1583 					aeb->pnum, ubi->peb_count);
1584 				goto bad_aeb;
1585 			}
1586 
1587 			if (av->vol_type == UBI_STATIC_VOLUME) {
1588 				if (aeb->lnum >= av->used_ebs) {
1589 					ubi_err(ubi, "bad lnum or used_ebs");
1590 					goto bad_aeb;
1591 				}
1592 			} else {
1593 				if (av->used_ebs != 0) {
1594 					ubi_err(ubi, "non-zero used_ebs");
1595 					goto bad_aeb;
1596 				}
1597 			}
1598 
1599 			if (aeb->lnum > av->highest_lnum) {
1600 				ubi_err(ubi, "incorrect highest_lnum or lnum");
1601 				goto bad_aeb;
1602 			}
1603 		}
1604 
1605 		if (av->leb_count != leb_count) {
1606 			ubi_err(ubi, "bad leb_count, %d objects in the tree",
1607 				leb_count);
1608 			goto bad_av;
1609 		}
1610 
1611 		if (!last_aeb)
1612 			continue;
1613 
1614 		aeb = last_aeb;
1615 
1616 		if (aeb->lnum != av->highest_lnum) {
1617 			ubi_err(ubi, "bad highest_lnum");
1618 			goto bad_aeb;
1619 		}
1620 	}
1621 
1622 	if (vols_found != ai->vols_found) {
1623 		ubi_err(ubi, "bad ai->vols_found %d, should be %d",
1624 			ai->vols_found, vols_found);
1625 		goto out;
1626 	}
1627 
1628 	/* Check that attaching information is correct */
1629 	ubi_rb_for_each_entry(rb1, av, &ai->volumes, rb) {
1630 		last_aeb = NULL;
1631 		ubi_rb_for_each_entry(rb2, aeb, &av->root, u.rb) {
1632 			int vol_type;
1633 
1634 			cond_resched();
1635 
1636 			last_aeb = aeb;
1637 
1638 			err = ubi_io_read_vid_hdr(ubi, aeb->pnum, vidh, 1);
1639 			if (err && err != UBI_IO_BITFLIPS) {
1640 				ubi_err(ubi, "VID header is not OK (%d)",
1641 					err);
1642 				if (err > 0)
1643 					err = -EIO;
1644 				return err;
1645 			}
1646 
1647 			vol_type = vidh->vol_type == UBI_VID_DYNAMIC ?
1648 				   UBI_DYNAMIC_VOLUME : UBI_STATIC_VOLUME;
1649 			if (av->vol_type != vol_type) {
1650 				ubi_err(ubi, "bad vol_type");
1651 				goto bad_vid_hdr;
1652 			}
1653 
1654 			if (aeb->sqnum != be64_to_cpu(vidh->sqnum)) {
1655 				ubi_err(ubi, "bad sqnum %llu", aeb->sqnum);
1656 				goto bad_vid_hdr;
1657 			}
1658 
1659 			if (av->vol_id != be32_to_cpu(vidh->vol_id)) {
1660 				ubi_err(ubi, "bad vol_id %d", av->vol_id);
1661 				goto bad_vid_hdr;
1662 			}
1663 
1664 			if (av->compat != vidh->compat) {
1665 				ubi_err(ubi, "bad compat %d", vidh->compat);
1666 				goto bad_vid_hdr;
1667 			}
1668 
1669 			if (aeb->lnum != be32_to_cpu(vidh->lnum)) {
1670 				ubi_err(ubi, "bad lnum %d", aeb->lnum);
1671 				goto bad_vid_hdr;
1672 			}
1673 
1674 			if (av->used_ebs != be32_to_cpu(vidh->used_ebs)) {
1675 				ubi_err(ubi, "bad used_ebs %d", av->used_ebs);
1676 				goto bad_vid_hdr;
1677 			}
1678 
1679 			if (av->data_pad != be32_to_cpu(vidh->data_pad)) {
1680 				ubi_err(ubi, "bad data_pad %d", av->data_pad);
1681 				goto bad_vid_hdr;
1682 			}
1683 		}
1684 
1685 		if (!last_aeb)
1686 			continue;
1687 
1688 		if (av->highest_lnum != be32_to_cpu(vidh->lnum)) {
1689 			ubi_err(ubi, "bad highest_lnum %d", av->highest_lnum);
1690 			goto bad_vid_hdr;
1691 		}
1692 
1693 		if (av->last_data_size != be32_to_cpu(vidh->data_size)) {
1694 			ubi_err(ubi, "bad last_data_size %d",
1695 				av->last_data_size);
1696 			goto bad_vid_hdr;
1697 		}
1698 	}
1699 
1700 	/*
1701 	 * Make sure that all the physical eraseblocks are in one of the lists
1702 	 * or trees.
1703 	 */
1704 	buf = kzalloc(ubi->peb_count, GFP_KERNEL);
1705 	if (!buf)
1706 		return -ENOMEM;
1707 
1708 	for (pnum = 0; pnum < ubi->peb_count; pnum++) {
1709 		err = ubi_io_is_bad(ubi, pnum);
1710 		if (err < 0) {
1711 			kfree(buf);
1712 			return err;
1713 		} else if (err)
1714 			buf[pnum] = 1;
1715 	}
1716 
1717 	ubi_rb_for_each_entry(rb1, av, &ai->volumes, rb)
1718 		ubi_rb_for_each_entry(rb2, aeb, &av->root, u.rb)
1719 			buf[aeb->pnum] = 1;
1720 
1721 	list_for_each_entry(aeb, &ai->free, u.list)
1722 		buf[aeb->pnum] = 1;
1723 
1724 	list_for_each_entry(aeb, &ai->corr, u.list)
1725 		buf[aeb->pnum] = 1;
1726 
1727 	list_for_each_entry(aeb, &ai->erase, u.list)
1728 		buf[aeb->pnum] = 1;
1729 
1730 	list_for_each_entry(aeb, &ai->alien, u.list)
1731 		buf[aeb->pnum] = 1;
1732 
1733 	err = 0;
1734 	for (pnum = 0; pnum < ubi->peb_count; pnum++)
1735 		if (!buf[pnum]) {
1736 			ubi_err(ubi, "PEB %d is not referred", pnum);
1737 			err = 1;
1738 		}
1739 
1740 	kfree(buf);
1741 	if (err)
1742 		goto out;
1743 	return 0;
1744 
1745 bad_aeb:
1746 	ubi_err(ubi, "bad attaching information about LEB %d", aeb->lnum);
1747 	ubi_dump_aeb(aeb, 0);
1748 	ubi_dump_av(av);
1749 	goto out;
1750 
1751 bad_av:
1752 	ubi_err(ubi, "bad attaching information about volume %d", av->vol_id);
1753 	ubi_dump_av(av);
1754 	goto out;
1755 
1756 bad_vid_hdr:
1757 	ubi_err(ubi, "bad attaching information about volume %d", av->vol_id);
1758 	ubi_dump_av(av);
1759 	ubi_dump_vid_hdr(vidh);
1760 
1761 out:
1762 	dump_stack();
1763 	return -EINVAL;
1764 }
1765