blob: 90fb74a5c966baeadf01e69c5ca6da9bb88d7e0f [file] [log] [blame]
Heiko Schocherf5895d12014-06-24 10:10:04 +02001/*
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
Heiko Schocherf5895d12014-06-24 10:10:04 +020073#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
88static int self_check_ai(struct ubi_device *ubi, struct ubi_attach_info *ai);
89
90/* Temporary variables used during scanning */
91static struct ubi_ec_hdr *ech;
92static 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 */
115static 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 */
156static 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.
Heiko Schocher94b66de2015-10-22 06:19:21 +0200175 * @ubi: UBI device description object
Heiko Schocherf5895d12014-06-24 10:10:04 +0200176 * @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 */
Heiko Schocher94b66de2015-10-22 06:19:21 +0200188static int validate_vid_hdr(const struct ubi_device *ubi,
189 const struct ubi_vid_hdr *vid_hdr,
Heiko Schocherf5895d12014-06-24 10:10:04 +0200190 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) {
Heiko Schocher94b66de2015-10-22 06:19:21 +0200207 ubi_err(ubi, "inconsistent vol_id");
Heiko Schocherf5895d12014-06-24 10:10:04 +0200208 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) {
Heiko Schocher94b66de2015-10-22 06:19:21 +0200217 ubi_err(ubi, "inconsistent vol_type");
Heiko Schocherf5895d12014-06-24 10:10:04 +0200218 goto bad;
219 }
220
221 if (used_ebs != av->used_ebs) {
Heiko Schocher94b66de2015-10-22 06:19:21 +0200222 ubi_err(ubi, "inconsistent used_ebs");
Heiko Schocherf5895d12014-06-24 10:10:04 +0200223 goto bad;
224 }
225
226 if (data_pad != av->data_pad) {
Heiko Schocher94b66de2015-10-22 06:19:21 +0200227 ubi_err(ubi, "inconsistent data_pad");
Heiko Schocherf5895d12014-06-24 10:10:04 +0200228 goto bad;
229 }
230 }
231
232 return 0;
233
234bad:
Heiko Schocher94b66de2015-10-22 06:19:21 +0200235 ubi_err(ubi, "inconsistent VID header at PEB %d", pnum);
Heiko Schocherf5895d12014-06-24 10:10:04 +0200236 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 */
254static 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 */
320int 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 */
Heiko Schocher94b66de2015-10-22 06:19:21 +0200337 ubi_err(ubi, "unsupported on-flash UBI format");
Heiko Schocherf5895d12014-06-24 10:10:04 +0200338 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 {
Heiko Schocher94b66de2015-10-22 06:19:21 +0200378 ubi_err(ubi, "VID of PEB %d header is bad, but it was OK earlier, err %d",
Heiko Schocherf5895d12014-06-24 10:10:04 +0200379 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);
Heiko Schocher94b66de2015-10-22 06:19:21 +0200409 bitflips |= !!err;
Heiko Schocherf5895d12014-06-24 10:10:04 +0200410 }
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
422out_unlock:
423 mutex_unlock(&ubi->buf_mutex);
424out_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 */
445int 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) {
Heiko Schocher94b66de2015-10-22 06:19:21 +0200508 ubi_err(ubi, "two LEBs with same sequence number %llu",
Heiko Schocherf5895d12014-06-24 10:10:04 +0200509 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 */
Heiko Schocher94b66de2015-10-22 06:19:21 +0200528 err = validate_vid_hdr(ubi, vid_hdr, av, pnum);
Heiko Schocherf5895d12014-06-24 10:10:04 +0200529 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
Heiko Schocher94b66de2015-10-22 06:19:21 +0200566 err = validate_vid_hdr(ubi, vid_hdr, av, pnum);
Heiko Schocherf5895d12014-06-24 10:10:04 +0200567 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 */
601struct 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 */
627void 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 */
658static 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 */
Heiko Schocher94b66de2015-10-22 06:19:21 +0200669 ubi_err(ubi, "erase counter overflow at PEB %d, EC %d",
670 pnum, ec);
Heiko Schocherf5895d12014-06-24 10:10:04 +0200671 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
686out_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 */
705struct 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
Heiko Schocher94b66de2015-10-22 06:19:21 +0200738 ubi_err(ubi, "no free eraseblocks");
Heiko Schocherf5895d12014-06-24 10:10:04 +0200739 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 */
759static 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
Heiko Schocher94b66de2015-10-22 06:19:21 +0200787 ubi_err(ubi, "PEB %d contains corrupted VID header, and the data does not contain all 0xFF",
Heiko Schocherf5895d12014-06-24 10:10:04 +0200788 pnum);
Heiko Schocher94b66de2015-10-22 06:19:21 +0200789 ubi_err(ubi, "this may be a non-UBI PEB or a severe VID header corruption which requires manual inspection");
Heiko Schocherf5895d12014-06-24 10:10:04 +0200790 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
797out_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 */
815static 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:
Heiko Schocher94b66de2015-10-22 06:19:21 +0200861 ubi_err(ubi, "'ubi_io_read_ec_hdr()' returned unknown code %d",
862 err);
Heiko Schocherf5895d12014-06-24 10:10:04 +0200863 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) {
Heiko Schocher94b66de2015-10-22 06:19:21 +0200871 ubi_err(ubi, "this UBI version is %d, image version is %d",
Heiko Schocherf5895d12014-06-24 10:10:04 +0200872 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 */
Heiko Schocher94b66de2015-10-22 06:19:21 +0200885 ubi_err(ubi, "erase counter overflow, max is %d",
Heiko Schocherf5895d12014-06-24 10:10:04 +0200886 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) {
Heiko Schocher94b66de2015-10-22 06:19:21 +0200906 ubi_err(ubi, "bad image sequence number %d in PEB %d, expected %d",
Heiko Schocherf5895d12014-06-24 10:10:04 +0200907 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:
Heiko Schocher94b66de2015-10-22 06:19:21 +0200984 ubi_err(ubi, "'ubi_io_read_vid_hdr()' returned unknown code %d",
Heiko Schocherf5895d12014-06-24 10:10:04 +0200985 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) {
Heiko Schocher94b66de2015-10-22 06:19:21 +02001002 ubi_msg(ubi, "\"delete\" compatible internal volume %d:%d found, will remove it",
Heiko Schocherf5895d12014-06-24 10:10:04 +02001003 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:
Heiko Schocher94b66de2015-10-22 06:19:21 +02001012 ubi_msg(ubi, "read-only compatible internal volume %d:%d found, switch to read-only mode",
Heiko Schocherf5895d12014-06-24 10:10:04 +02001013 vol_id, lnum);
1014 ubi->ro_mode = 1;
1015 break;
1016
1017 case UBI_COMPAT_PRESERVE:
Heiko Schocher94b66de2015-10-22 06:19:21 +02001018 ubi_msg(ubi, "\"preserve\" compatible internal volume %d:%d found",
Heiko Schocherf5895d12014-06-24 10:10:04 +02001019 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:
Heiko Schocher94b66de2015-10-22 06:19:21 +02001027 ubi_err(ubi, "incompatible internal volume %d:%d found",
Heiko Schocherf5895d12014-06-24 10:10:04 +02001028 vol_id, lnum);
1029 return -EINVAL;
1030 }
1031 }
1032
1033 if (ec_err)
Heiko Schocher94b66de2015-10-22 06:19:21 +02001034 ubi_warn(ubi, "valid VID header but corrupted EC header at PEB %d",
Heiko Schocherf5895d12014-06-24 10:10:04 +02001035 pnum);
1036 err = ubi_add_to_av(ubi, ai, pnum, ec, vidh, bitflips);
1037 if (err)
1038 return err;
1039
1040adjust_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 */
1064static 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) {
Heiko Schocher94b66de2015-10-22 06:19:21 +02001078 ubi_err(ubi, "%d PEBs are corrupted and preserved",
Heiko Schocherf5895d12014-06-24 10:10:04 +02001079 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) {
Heiko Schocher94b66de2015-10-22 06:19:21 +02001090 ubi_err(ubi, "too many corrupted PEBs, refusing");
Heiko Schocherf5895d12014-06-24 10:10:04 +02001091 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;
Heiko Schocher94b66de2015-10-22 06:19:21 +02001113 ubi_msg(ubi, "empty MTD device detected");
Heiko Schocherf5895d12014-06-24 10:10:04 +02001114 get_random_bytes(&ubi->image_seq,
1115 sizeof(ubi->image_seq));
1116 } else {
Heiko Schocher94b66de2015-10-22 06:19:21 +02001117 ubi_err(ubi, "MTD device is not UBI-formatted and possibly contains non-UBI data - refusing it");
Heiko Schocherf5895d12014-06-24 10:10:04 +02001118 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 */
1133static 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 */
1163static 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 */
1224static 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
Heiko Schocher94b66de2015-10-22 06:19:21 +02001251 ubi_msg(ubi, "scanning is finished");
Heiko Schocherf5895d12014-06-24 10:10:04 +02001252
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
1293out_vidh:
1294 ubi_free_vid_hdr(ubi, vidh);
1295out_ech:
1296 kfree(ech);
1297 return err;
1298}
1299
Heiko Schocher94b66de2015-10-22 06:19:21 +02001300static 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
Heiko Schocherf5895d12014-06-24 10:10:04 +02001324#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 */
Heiko Schocher94b66de2015-10-22 06:19:21 +02001336static int scan_fast(struct ubi_device *ubi, struct ubi_attach_info **ai)
Heiko Schocherf5895d12014-06-24 10:10:04 +02001337{
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);
Heiko Schocher94b66de2015-10-22 06:19:21 +02001357 err = scan_peb(ubi, *ai, pnum, &vol_id, &sqnum);
Heiko Schocherf5895d12014-06-24 10:10:04 +02001358 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
Heiko Schocher94b66de2015-10-22 06:19:21 +02001373 destroy_ai(*ai);
1374 *ai = alloc_ai();
1375 if (!*ai)
1376 return -ENOMEM;
1377
1378 return ubi_scan_fastmap(ubi, *ai, fm_anchor);
Heiko Schocherf5895d12014-06-24 10:10:04 +02001379
1380out_vidh:
1381 ubi_free_vid_hdr(ubi, vidh);
1382out_ech:
1383 kfree(ech);
1384out:
1385 return err;
1386}
1387
1388#endif
1389
Heiko Schocherf5895d12014-06-24 10:10:04 +02001390/**
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 */
1398int ubi_attach(struct ubi_device *ubi, int force_scan)
1399{
1400 int err;
1401 struct ubi_attach_info *ai;
1402
Heiko Schocher94b66de2015-10-22 06:19:21 +02001403 ai = alloc_ai();
Heiko Schocherf5895d12014-06-24 10:10:04 +02001404 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 {
Heiko Schocher94b66de2015-10-22 06:19:21 +02001417 err = scan_fast(ubi, &ai);
1418 if (err > 0 || mtd_is_eccerr(err)) {
Heiko Schocherf5895d12014-06-24 10:10:04 +02001419 if (err != UBI_NO_FASTMAP) {
1420 destroy_ai(ai);
Heiko Schocher94b66de2015-10-22 06:19:21 +02001421 ai = alloc_ai();
Heiko Schocherf5895d12014-06-24 10:10:04 +02001422 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
Heiko Schocher94b66de2015-10-22 06:19:21 +02001457 if (ubi->fm && ubi_dbg_chk_fastmap(ubi)) {
Heiko Schocherf5895d12014-06-24 10:10:04 +02001458 struct ubi_attach_info *scan_ai;
1459
Heiko Schocher94b66de2015-10-22 06:19:21 +02001460 scan_ai = alloc_ai();
Heiko Schocherf5895d12014-06-24 10:10:04 +02001461 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
1483out_wl:
1484 ubi_wl_close(ubi);
1485out_vtbl:
1486 ubi_free_internal_volumes(ubi);
1487 vfree(ubi->vtbl);
1488out_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 */
1501static 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) {
Heiko Schocher94b66de2015-10-22 06:19:21 +02001523 ubi_err(ubi, "bad is_empty flag");
Heiko Schocherf5895d12014-06-24 10:10:04 +02001524 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) {
Heiko Schocher94b66de2015-10-22 06:19:21 +02001530 ubi_err(ubi, "negative values");
Heiko Schocherf5895d12014-06-24 10:10:04 +02001531 goto bad_av;
1532 }
1533
1534 if (av->vol_id >= UBI_MAX_VOLUMES &&
1535 av->vol_id < UBI_INTERNAL_VOL_START) {
Heiko Schocher94b66de2015-10-22 06:19:21 +02001536 ubi_err(ubi, "bad vol_id");
Heiko Schocherf5895d12014-06-24 10:10:04 +02001537 goto bad_av;
1538 }
1539
1540 if (av->vol_id > ai->highest_vol_id) {
Heiko Schocher94b66de2015-10-22 06:19:21 +02001541 ubi_err(ubi, "highest_vol_id is %d, but vol_id %d is there",
Heiko Schocherf5895d12014-06-24 10:10:04 +02001542 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) {
Heiko Schocher94b66de2015-10-22 06:19:21 +02001548 ubi_err(ubi, "bad vol_type");
Heiko Schocherf5895d12014-06-24 10:10:04 +02001549 goto bad_av;
1550 }
1551
1552 if (av->data_pad > ubi->leb_size / 2) {
Heiko Schocher94b66de2015-10-22 06:19:21 +02001553 ubi_err(ubi, "bad data_pad");
Heiko Schocherf5895d12014-06-24 10:10:04 +02001554 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) {
Heiko Schocher94b66de2015-10-22 06:19:21 +02001565 ubi_err(ubi, "negative values");
Heiko Schocherf5895d12014-06-24 10:10:04 +02001566 goto bad_aeb;
1567 }
1568
1569 if (aeb->ec < ai->min_ec) {
Heiko Schocher94b66de2015-10-22 06:19:21 +02001570 ubi_err(ubi, "bad ai->min_ec (%d), %d found",
Heiko Schocherf5895d12014-06-24 10:10:04 +02001571 ai->min_ec, aeb->ec);
1572 goto bad_aeb;
1573 }
1574
1575 if (aeb->ec > ai->max_ec) {
Heiko Schocher94b66de2015-10-22 06:19:21 +02001576 ubi_err(ubi, "bad ai->max_ec (%d), %d found",
Heiko Schocherf5895d12014-06-24 10:10:04 +02001577 ai->max_ec, aeb->ec);
1578 goto bad_aeb;
1579 }
1580
1581 if (aeb->pnum >= ubi->peb_count) {
Heiko Schocher94b66de2015-10-22 06:19:21 +02001582 ubi_err(ubi, "too high PEB number %d, total PEBs %d",
Heiko Schocherf5895d12014-06-24 10:10:04 +02001583 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) {
Heiko Schocher94b66de2015-10-22 06:19:21 +02001589 ubi_err(ubi, "bad lnum or used_ebs");
Heiko Schocherf5895d12014-06-24 10:10:04 +02001590 goto bad_aeb;
1591 }
1592 } else {
1593 if (av->used_ebs != 0) {
Heiko Schocher94b66de2015-10-22 06:19:21 +02001594 ubi_err(ubi, "non-zero used_ebs");
Heiko Schocherf5895d12014-06-24 10:10:04 +02001595 goto bad_aeb;
1596 }
1597 }
1598
1599 if (aeb->lnum > av->highest_lnum) {
Heiko Schocher94b66de2015-10-22 06:19:21 +02001600 ubi_err(ubi, "incorrect highest_lnum or lnum");
Heiko Schocherf5895d12014-06-24 10:10:04 +02001601 goto bad_aeb;
1602 }
1603 }
1604
1605 if (av->leb_count != leb_count) {
Heiko Schocher94b66de2015-10-22 06:19:21 +02001606 ubi_err(ubi, "bad leb_count, %d objects in the tree",
Heiko Schocherf5895d12014-06-24 10:10:04 +02001607 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) {
Heiko Schocher94b66de2015-10-22 06:19:21 +02001617 ubi_err(ubi, "bad highest_lnum");
Heiko Schocherf5895d12014-06-24 10:10:04 +02001618 goto bad_aeb;
1619 }
1620 }
1621
1622 if (vols_found != ai->vols_found) {
Heiko Schocher94b66de2015-10-22 06:19:21 +02001623 ubi_err(ubi, "bad ai->vols_found %d, should be %d",
Heiko Schocherf5895d12014-06-24 10:10:04 +02001624 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) {
Heiko Schocher94b66de2015-10-22 06:19:21 +02001640 ubi_err(ubi, "VID header is not OK (%d)",
1641 err);
Heiko Schocherf5895d12014-06-24 10:10:04 +02001642 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) {
Heiko Schocher94b66de2015-10-22 06:19:21 +02001650 ubi_err(ubi, "bad vol_type");
Heiko Schocherf5895d12014-06-24 10:10:04 +02001651 goto bad_vid_hdr;
1652 }
1653
1654 if (aeb->sqnum != be64_to_cpu(vidh->sqnum)) {
Heiko Schocher94b66de2015-10-22 06:19:21 +02001655 ubi_err(ubi, "bad sqnum %llu", aeb->sqnum);
Heiko Schocherf5895d12014-06-24 10:10:04 +02001656 goto bad_vid_hdr;
1657 }
1658
1659 if (av->vol_id != be32_to_cpu(vidh->vol_id)) {
Heiko Schocher94b66de2015-10-22 06:19:21 +02001660 ubi_err(ubi, "bad vol_id %d", av->vol_id);
Heiko Schocherf5895d12014-06-24 10:10:04 +02001661 goto bad_vid_hdr;
1662 }
1663
1664 if (av->compat != vidh->compat) {
Heiko Schocher94b66de2015-10-22 06:19:21 +02001665 ubi_err(ubi, "bad compat %d", vidh->compat);
Heiko Schocherf5895d12014-06-24 10:10:04 +02001666 goto bad_vid_hdr;
1667 }
1668
1669 if (aeb->lnum != be32_to_cpu(vidh->lnum)) {
Heiko Schocher94b66de2015-10-22 06:19:21 +02001670 ubi_err(ubi, "bad lnum %d", aeb->lnum);
Heiko Schocherf5895d12014-06-24 10:10:04 +02001671 goto bad_vid_hdr;
1672 }
1673
1674 if (av->used_ebs != be32_to_cpu(vidh->used_ebs)) {
Heiko Schocher94b66de2015-10-22 06:19:21 +02001675 ubi_err(ubi, "bad used_ebs %d", av->used_ebs);
Heiko Schocherf5895d12014-06-24 10:10:04 +02001676 goto bad_vid_hdr;
1677 }
1678
1679 if (av->data_pad != be32_to_cpu(vidh->data_pad)) {
Heiko Schocher94b66de2015-10-22 06:19:21 +02001680 ubi_err(ubi, "bad data_pad %d", av->data_pad);
Heiko Schocherf5895d12014-06-24 10:10:04 +02001681 goto bad_vid_hdr;
1682 }
1683 }
1684
1685 if (!last_aeb)
1686 continue;
1687
1688 if (av->highest_lnum != be32_to_cpu(vidh->lnum)) {
Heiko Schocher94b66de2015-10-22 06:19:21 +02001689 ubi_err(ubi, "bad highest_lnum %d", av->highest_lnum);
Heiko Schocherf5895d12014-06-24 10:10:04 +02001690 goto bad_vid_hdr;
1691 }
1692
1693 if (av->last_data_size != be32_to_cpu(vidh->data_size)) {
Heiko Schocher94b66de2015-10-22 06:19:21 +02001694 ubi_err(ubi, "bad last_data_size %d",
1695 av->last_data_size);
Heiko Schocherf5895d12014-06-24 10:10:04 +02001696 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]) {
Heiko Schocher94b66de2015-10-22 06:19:21 +02001736 ubi_err(ubi, "PEB %d is not referred", pnum);
Heiko Schocherf5895d12014-06-24 10:10:04 +02001737 err = 1;
1738 }
1739
1740 kfree(buf);
1741 if (err)
1742 goto out;
1743 return 0;
1744
1745bad_aeb:
Heiko Schocher94b66de2015-10-22 06:19:21 +02001746 ubi_err(ubi, "bad attaching information about LEB %d", aeb->lnum);
Heiko Schocherf5895d12014-06-24 10:10:04 +02001747 ubi_dump_aeb(aeb, 0);
1748 ubi_dump_av(av);
1749 goto out;
1750
1751bad_av:
Heiko Schocher94b66de2015-10-22 06:19:21 +02001752 ubi_err(ubi, "bad attaching information about volume %d", av->vol_id);
Heiko Schocherf5895d12014-06-24 10:10:04 +02001753 ubi_dump_av(av);
1754 goto out;
1755
1756bad_vid_hdr:
Heiko Schocher94b66de2015-10-22 06:19:21 +02001757 ubi_err(ubi, "bad attaching information about volume %d", av->vol_id);
Heiko Schocherf5895d12014-06-24 10:10:04 +02001758 ubi_dump_av(av);
1759 ubi_dump_vid_hdr(vidh);
1760
1761out:
1762 dump_stack();
1763 return -EINVAL;
1764}