1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76#include <linux/crc32.h>
77#include <linux/err.h>
78#include <linux/slab.h>
79#include "ubi.h"
80
81static int self_check_not_bad(const struct ubi_device *ubi, int pnum);
82static int self_check_peb_ec_hdr(const struct ubi_device *ubi, int pnum);
83static int self_check_ec_hdr(const struct ubi_device *ubi, int pnum,
84 const struct ubi_ec_hdr *ec_hdr);
85static int self_check_peb_vid_hdr(const struct ubi_device *ubi, int pnum);
86static int self_check_vid_hdr(const struct ubi_device *ubi, int pnum,
87 const struct ubi_vid_hdr *vid_hdr);
88static int self_check_write(struct ubi_device *ubi, const void *buf, int pnum,
89 int offset, int len);
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113int ubi_io_read(const struct ubi_device *ubi, void *buf, int pnum, int offset,
114 int len)
115{
116 int err, retries = 0;
117 size_t read;
118 loff_t addr;
119
120 dbg_io("read %d bytes from PEB %d:%d", len, pnum, offset);
121
122 ubi_assert(pnum >= 0 && pnum < ubi->peb_count);
123 ubi_assert(offset >= 0 && offset + len <= ubi->peb_size);
124 ubi_assert(len > 0);
125
126 err = self_check_not_bad(ubi, pnum);
127 if (err)
128 return err;
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150 *((uint8_t *)buf) ^= 0xFF;
151
152 addr = (loff_t)pnum * ubi->peb_size + offset;
153retry:
154 err = mtd_read(ubi->mtd, addr, len, &read, buf);
155 if (err) {
156 const char *errstr = mtd_is_eccerr(err) ? " (ECC error)" : "";
157
158 if (mtd_is_bitflip(err)) {
159
160
161
162
163
164
165
166
167 ubi_msg(ubi, "fixable bit-flip detected at PEB %d",
168 pnum);
169 ubi_assert(len == read);
170 return UBI_IO_BITFLIPS;
171 }
172
173 if (retries++ < UBI_IO_RETRIES) {
174 ubi_warn(ubi, "error %d%s while reading %d bytes from PEB %d:%d, read only %zd bytes, retry",
175 err, errstr, len, pnum, offset, read);
176 yield();
177 goto retry;
178 }
179
180 ubi_err(ubi, "error %d%s while reading %d bytes from PEB %d:%d, read %zd bytes",
181 err, errstr, len, pnum, offset, read);
182 dump_stack();
183
184
185
186
187
188
189 if (read != len && mtd_is_eccerr(err)) {
190 ubi_assert(0);
191 err = -EIO;
192 }
193 } else {
194 ubi_assert(len == read);
195
196 if (ubi_dbg_is_bitflip(ubi)) {
197 dbg_gen("bit-flip (emulated)");
198 err = UBI_IO_BITFLIPS;
199 }
200 }
201
202 return err;
203}
204
205
206
207
208
209
210
211
212
213
214
215
216
217
218
219
220
221
222int ubi_io_write(struct ubi_device *ubi, const void *buf, int pnum, int offset,
223 int len)
224{
225 int err;
226 size_t written;
227 loff_t addr;
228
229 dbg_io("write %d bytes to PEB %d:%d", len, pnum, offset);
230
231 ubi_assert(pnum >= 0 && pnum < ubi->peb_count);
232 ubi_assert(offset >= 0 && offset + len <= ubi->peb_size);
233 ubi_assert(offset % ubi->hdrs_min_io_size == 0);
234 ubi_assert(len > 0 && len % ubi->hdrs_min_io_size == 0);
235
236 if (ubi->ro_mode) {
237 ubi_err(ubi, "read-only mode");
238 return -EROFS;
239 }
240
241 err = self_check_not_bad(ubi, pnum);
242 if (err)
243 return err;
244
245
246 err = ubi_self_check_all_ff(ubi, pnum, offset, len);
247 if (err)
248 return err;
249
250 if (offset >= ubi->leb_start) {
251
252
253
254
255 err = self_check_peb_ec_hdr(ubi, pnum);
256 if (err)
257 return err;
258 err = self_check_peb_vid_hdr(ubi, pnum);
259 if (err)
260 return err;
261 }
262
263 if (ubi_dbg_is_write_failure(ubi)) {
264 ubi_err(ubi, "cannot write %d bytes to PEB %d:%d (emulated)",
265 len, pnum, offset);
266 dump_stack();
267 return -EIO;
268 }
269
270 addr = (loff_t)pnum * ubi->peb_size + offset;
271 err = mtd_write(ubi->mtd, addr, len, &written, buf);
272 if (err) {
273 ubi_err(ubi, "error %d while writing %d bytes to PEB %d:%d, written %zd bytes",
274 err, len, pnum, offset, written);
275 dump_stack();
276 ubi_dump_flash(ubi, pnum, offset, len);
277 } else
278 ubi_assert(written == len);
279
280 if (!err) {
281 err = self_check_write(ubi, buf, pnum, offset, len);
282 if (err)
283 return err;
284
285
286
287
288
289 offset += len;
290 len = ubi->peb_size - offset;
291 if (len)
292 err = ubi_self_check_all_ff(ubi, pnum, offset, len);
293 }
294
295 return err;
296}
297
298
299
300
301
302
303
304
305
306
307static int do_sync_erase(struct ubi_device *ubi, int pnum)
308{
309 int err, retries = 0;
310 struct erase_info ei;
311
312 dbg_io("erase PEB %d", pnum);
313 ubi_assert(pnum >= 0 && pnum < ubi->peb_count);
314
315 if (ubi->ro_mode) {
316 ubi_err(ubi, "read-only mode");
317 return -EROFS;
318 }
319
320retry:
321 memset(&ei, 0, sizeof(struct erase_info));
322
323 ei.addr = (loff_t)pnum * ubi->peb_size;
324 ei.len = ubi->peb_size;
325
326 err = mtd_erase(ubi->mtd, &ei);
327 if (err) {
328 if (retries++ < UBI_IO_RETRIES) {
329 ubi_warn(ubi, "error %d while erasing PEB %d, retry",
330 err, pnum);
331 yield();
332 goto retry;
333 }
334 ubi_err(ubi, "cannot erase PEB %d, error %d", pnum, err);
335 dump_stack();
336 return err;
337 }
338
339 err = ubi_self_check_all_ff(ubi, pnum, 0, ubi->peb_size);
340 if (err)
341 return err;
342
343 if (ubi_dbg_is_erase_failure(ubi)) {
344 ubi_err(ubi, "cannot erase PEB %d (emulated)", pnum);
345 return -EIO;
346 }
347
348 return 0;
349}
350
351
352static uint8_t patterns[] = {0xa5, 0x5a, 0x0};
353
354
355
356
357
358
359
360
361
362
363static int torture_peb(struct ubi_device *ubi, int pnum)
364{
365 int err, i, patt_count;
366
367 ubi_msg(ubi, "run torture test for PEB %d", pnum);
368 patt_count = ARRAY_SIZE(patterns);
369 ubi_assert(patt_count > 0);
370
371 mutex_lock(&ubi->buf_mutex);
372 for (i = 0; i < patt_count; i++) {
373 err = do_sync_erase(ubi, pnum);
374 if (err)
375 goto out;
376
377
378 err = ubi_io_read(ubi, ubi->peb_buf, pnum, 0, ubi->peb_size);
379 if (err)
380 goto out;
381
382 err = ubi_check_pattern(ubi->peb_buf, 0xFF, ubi->peb_size);
383 if (err == 0) {
384 ubi_err(ubi, "erased PEB %d, but a non-0xFF byte found",
385 pnum);
386 err = -EIO;
387 goto out;
388 }
389
390
391 memset(ubi->peb_buf, patterns[i], ubi->peb_size);
392 err = ubi_io_write(ubi, ubi->peb_buf, pnum, 0, ubi->peb_size);
393 if (err)
394 goto out;
395
396 memset(ubi->peb_buf, ~patterns[i], ubi->peb_size);
397 err = ubi_io_read(ubi, ubi->peb_buf, pnum, 0, ubi->peb_size);
398 if (err)
399 goto out;
400
401 err = ubi_check_pattern(ubi->peb_buf, patterns[i],
402 ubi->peb_size);
403 if (err == 0) {
404 ubi_err(ubi, "pattern %x checking failed for PEB %d",
405 patterns[i], pnum);
406 err = -EIO;
407 goto out;
408 }
409 }
410
411 err = patt_count;
412 ubi_msg(ubi, "PEB %d passed torture test, do not mark it as bad", pnum);
413
414out:
415 mutex_unlock(&ubi->buf_mutex);
416 if (err == UBI_IO_BITFLIPS || mtd_is_eccerr(err)) {
417
418
419
420
421
422 ubi_err(ubi, "read problems on freshly erased PEB %d, must be bad",
423 pnum);
424 err = -EIO;
425 }
426 return err;
427}
428
429
430
431
432
433
434
435
436
437
438
439
440
441
442
443
444
445
446
447
448
449static int nor_erase_prepare(struct ubi_device *ubi, int pnum)
450{
451 int err;
452 size_t written;
453 loff_t addr;
454 uint32_t data = 0;
455 struct ubi_ec_hdr ec_hdr;
456 struct ubi_vid_io_buf vidb;
457
458
459
460
461
462
463
464
465 struct ubi_vid_hdr vid_hdr;
466
467
468
469
470
471
472
473
474 addr = (loff_t)pnum * ubi->peb_size;
475 err = ubi_io_read_ec_hdr(ubi, pnum, &ec_hdr, 0);
476 if (err != UBI_IO_BAD_HDR_EBADMSG && err != UBI_IO_BAD_HDR &&
477 err != UBI_IO_FF){
478 err = mtd_write(ubi->mtd, addr, 4, &written, (void *)&data);
479 if(err)
480 goto error;
481 }
482
483 ubi_init_vid_buf(ubi, &vidb, &vid_hdr);
484 ubi_assert(&vid_hdr == ubi_get_vid_hdr(&vidb));
485
486 err = ubi_io_read_vid_hdr(ubi, pnum, &vidb, 0);
487 if (err != UBI_IO_BAD_HDR_EBADMSG && err != UBI_IO_BAD_HDR &&
488 err != UBI_IO_FF){
489 addr += ubi->vid_hdr_aloffset;
490 err = mtd_write(ubi->mtd, addr, 4, &written, (void *)&data);
491 if (err)
492 goto error;
493 }
494 return 0;
495
496error:
497
498
499
500
501
502 ubi_err(ubi, "cannot invalidate PEB %d, write returned %d", pnum, err);
503 ubi_dump_flash(ubi, pnum, 0, ubi->peb_size);
504 return -EIO;
505}
506
507
508
509
510
511
512
513
514
515
516
517
518
519
520
521
522
523int ubi_io_sync_erase(struct ubi_device *ubi, int pnum, int torture)
524{
525 int err, ret = 0;
526
527 ubi_assert(pnum >= 0 && pnum < ubi->peb_count);
528
529 err = self_check_not_bad(ubi, pnum);
530 if (err != 0)
531 return err;
532
533 if (ubi->ro_mode) {
534 ubi_err(ubi, "read-only mode");
535 return -EROFS;
536 }
537
538 if (ubi->nor_flash) {
539 err = nor_erase_prepare(ubi, pnum);
540 if (err)
541 return err;
542 }
543
544 if (torture) {
545 ret = torture_peb(ubi, pnum);
546 if (ret < 0)
547 return ret;
548 }
549
550 err = do_sync_erase(ubi, pnum);
551 if (err)
552 return err;
553
554 return ret + 1;
555}
556
557
558
559
560
561
562
563
564
565int ubi_io_is_bad(const struct ubi_device *ubi, int pnum)
566{
567 struct mtd_info *mtd = ubi->mtd;
568
569 ubi_assert(pnum >= 0 && pnum < ubi->peb_count);
570
571 if (ubi->bad_allowed) {
572 int ret;
573
574 ret = mtd_block_isbad(mtd, (loff_t)pnum * ubi->peb_size);
575 if (ret < 0)
576 ubi_err(ubi, "error %d while checking if PEB %d is bad",
577 ret, pnum);
578 else if (ret)
579 dbg_io("PEB %d is bad", pnum);
580 return ret;
581 }
582
583 return 0;
584}
585
586
587
588
589
590
591
592
593
594int ubi_io_mark_bad(const struct ubi_device *ubi, int pnum)
595{
596 int err;
597 struct mtd_info *mtd = ubi->mtd;
598
599 ubi_assert(pnum >= 0 && pnum < ubi->peb_count);
600
601 if (ubi->ro_mode) {
602 ubi_err(ubi, "read-only mode");
603 return -EROFS;
604 }
605
606 if (!ubi->bad_allowed)
607 return 0;
608
609 err = mtd_block_markbad(mtd, (loff_t)pnum * ubi->peb_size);
610 if (err)
611 ubi_err(ubi, "cannot mark PEB %d bad, error %d", pnum, err);
612 return err;
613}
614
615
616
617
618
619
620
621
622
623static int validate_ec_hdr(const struct ubi_device *ubi,
624 const struct ubi_ec_hdr *ec_hdr)
625{
626 long long ec;
627 int vid_hdr_offset, leb_start;
628
629 ec = be64_to_cpu(ec_hdr->ec);
630 vid_hdr_offset = be32_to_cpu(ec_hdr->vid_hdr_offset);
631 leb_start = be32_to_cpu(ec_hdr->data_offset);
632
633 if (ec_hdr->version != UBI_VERSION) {
634 ubi_err(ubi, "node with incompatible UBI version found: this UBI version is %d, image version is %d",
635 UBI_VERSION, (int)ec_hdr->version);
636 goto bad;
637 }
638
639 if (vid_hdr_offset != ubi->vid_hdr_offset) {
640 ubi_err(ubi, "bad VID header offset %d, expected %d",
641 vid_hdr_offset, ubi->vid_hdr_offset);
642 goto bad;
643 }
644
645 if (leb_start != ubi->leb_start) {
646 ubi_err(ubi, "bad data offset %d, expected %d",
647 leb_start, ubi->leb_start);
648 goto bad;
649 }
650
651 if (ec < 0 || ec > UBI_MAX_ERASECOUNTER) {
652 ubi_err(ubi, "bad erase counter %lld", ec);
653 goto bad;
654 }
655
656 return 0;
657
658bad:
659 ubi_err(ubi, "bad EC header");
660 ubi_dump_ec_hdr(ec_hdr);
661 dump_stack();
662 return 1;
663}
664
665
666
667
668
669
670
671
672
673
674
675
676
677
678
679
680
681
682
683
684
685
686
687int ubi_io_read_ec_hdr(struct ubi_device *ubi, int pnum,
688 struct ubi_ec_hdr *ec_hdr, int verbose)
689{
690 int err, read_err;
691 uint32_t crc, magic, hdr_crc;
692
693 dbg_io("read EC header from PEB %d", pnum);
694 ubi_assert(pnum >= 0 && pnum < ubi->peb_count);
695
696 read_err = ubi_io_read(ubi, ec_hdr, pnum, 0, UBI_EC_HDR_SIZE);
697 if (read_err) {
698 if (read_err != UBI_IO_BITFLIPS && !mtd_is_eccerr(read_err))
699 return read_err;
700
701
702
703
704
705
706
707
708
709
710 }
711
712 magic = be32_to_cpu(ec_hdr->magic);
713 if (magic != UBI_EC_HDR_MAGIC) {
714 if (mtd_is_eccerr(read_err))
715 return UBI_IO_BAD_HDR_EBADMSG;
716
717
718
719
720
721
722 if (ubi_check_pattern(ec_hdr, 0xFF, UBI_EC_HDR_SIZE)) {
723
724 if (verbose)
725 ubi_warn(ubi, "no EC header found at PEB %d, only 0xFF bytes",
726 pnum);
727 dbg_bld("no EC header found at PEB %d, only 0xFF bytes",
728 pnum);
729 if (!read_err)
730 return UBI_IO_FF;
731 else
732 return UBI_IO_FF_BITFLIPS;
733 }
734
735
736
737
738
739 if (verbose) {
740 ubi_warn(ubi, "bad magic number at PEB %d: %08x instead of %08x",
741 pnum, magic, UBI_EC_HDR_MAGIC);
742 ubi_dump_ec_hdr(ec_hdr);
743 }
744 dbg_bld("bad magic number at PEB %d: %08x instead of %08x",
745 pnum, magic, UBI_EC_HDR_MAGIC);
746 return UBI_IO_BAD_HDR;
747 }
748
749 crc = crc32(UBI_CRC32_INIT, ec_hdr, UBI_EC_HDR_SIZE_CRC);
750 hdr_crc = be32_to_cpu(ec_hdr->hdr_crc);
751
752 if (hdr_crc != crc) {
753 if (verbose) {
754 ubi_warn(ubi, "bad EC header CRC at PEB %d, calculated %#08x, read %#08x",
755 pnum, crc, hdr_crc);
756 ubi_dump_ec_hdr(ec_hdr);
757 }
758 dbg_bld("bad EC header CRC at PEB %d, calculated %#08x, read %#08x",
759 pnum, crc, hdr_crc);
760
761 if (!read_err)
762 return UBI_IO_BAD_HDR;
763 else
764 return UBI_IO_BAD_HDR_EBADMSG;
765 }
766
767
768 err = validate_ec_hdr(ubi, ec_hdr);
769 if (err) {
770 ubi_err(ubi, "validation failed for PEB %d", pnum);
771 return -EINVAL;
772 }
773
774
775
776
777
778 return read_err ? UBI_IO_BITFLIPS : 0;
779}
780
781
782
783
784
785
786
787
788
789
790
791
792
793
794
795
796int ubi_io_write_ec_hdr(struct ubi_device *ubi, int pnum,
797 struct ubi_ec_hdr *ec_hdr)
798{
799 int err;
800 uint32_t crc;
801
802 dbg_io("write EC header to PEB %d", pnum);
803 ubi_assert(pnum >= 0 && pnum < ubi->peb_count);
804
805 ec_hdr->magic = cpu_to_be32(UBI_EC_HDR_MAGIC);
806 ec_hdr->version = UBI_VERSION;
807 ec_hdr->vid_hdr_offset = cpu_to_be32(ubi->vid_hdr_offset);
808 ec_hdr->data_offset = cpu_to_be32(ubi->leb_start);
809 ec_hdr->image_seq = cpu_to_be32(ubi->image_seq);
810 crc = crc32(UBI_CRC32_INIT, ec_hdr, UBI_EC_HDR_SIZE_CRC);
811 ec_hdr->hdr_crc = cpu_to_be32(crc);
812
813 err = self_check_ec_hdr(ubi, pnum, ec_hdr);
814 if (err)
815 return err;
816
817 if (ubi_dbg_power_cut(ubi, POWER_CUT_EC_WRITE))
818 return -EROFS;
819
820 err = ubi_io_write(ubi, ec_hdr, pnum, 0, ubi->ec_hdr_alsize);
821 return err;
822}
823
824
825
826
827
828
829
830
831
832static int validate_vid_hdr(const struct ubi_device *ubi,
833 const struct ubi_vid_hdr *vid_hdr)
834{
835 int vol_type = vid_hdr->vol_type;
836 int copy_flag = vid_hdr->copy_flag;
837 int vol_id = be32_to_cpu(vid_hdr->vol_id);
838 int lnum = be32_to_cpu(vid_hdr->lnum);
839 int compat = vid_hdr->compat;
840 int data_size = be32_to_cpu(vid_hdr->data_size);
841 int used_ebs = be32_to_cpu(vid_hdr->used_ebs);
842 int data_pad = be32_to_cpu(vid_hdr->data_pad);
843 int data_crc = be32_to_cpu(vid_hdr->data_crc);
844 int usable_leb_size = ubi->leb_size - data_pad;
845
846 if (copy_flag != 0 && copy_flag != 1) {
847 ubi_err(ubi, "bad copy_flag");
848 goto bad;
849 }
850
851 if (vol_id < 0 || lnum < 0 || data_size < 0 || used_ebs < 0 ||
852 data_pad < 0) {
853 ubi_err(ubi, "negative values");
854 goto bad;
855 }
856
857 if (vol_id >= UBI_MAX_VOLUMES && vol_id < UBI_INTERNAL_VOL_START) {
858 ubi_err(ubi, "bad vol_id");
859 goto bad;
860 }
861
862 if (vol_id < UBI_INTERNAL_VOL_START && compat != 0) {
863 ubi_err(ubi, "bad compat");
864 goto bad;
865 }
866
867 if (vol_id >= UBI_INTERNAL_VOL_START && compat != UBI_COMPAT_DELETE &&
868 compat != UBI_COMPAT_RO && compat != UBI_COMPAT_PRESERVE &&
869 compat != UBI_COMPAT_REJECT) {
870 ubi_err(ubi, "bad compat");
871 goto bad;
872 }
873
874 if (vol_type != UBI_VID_DYNAMIC && vol_type != UBI_VID_STATIC) {
875 ubi_err(ubi, "bad vol_type");
876 goto bad;
877 }
878
879 if (data_pad >= ubi->leb_size / 2) {
880 ubi_err(ubi, "bad data_pad");
881 goto bad;
882 }
883
884 if (data_size > ubi->leb_size) {
885 ubi_err(ubi, "bad data_size");
886 goto bad;
887 }
888
889 if (vol_type == UBI_VID_STATIC) {
890
891
892
893
894
895
896 if (used_ebs == 0) {
897 ubi_err(ubi, "zero used_ebs");
898 goto bad;
899 }
900 if (data_size == 0) {
901 ubi_err(ubi, "zero data_size");
902 goto bad;
903 }
904 if (lnum < used_ebs - 1) {
905 if (data_size != usable_leb_size) {
906 ubi_err(ubi, "bad data_size");
907 goto bad;
908 }
909 } else if (lnum == used_ebs - 1) {
910 if (data_size == 0) {
911 ubi_err(ubi, "bad data_size at last LEB");
912 goto bad;
913 }
914 } else {
915 ubi_err(ubi, "too high lnum");
916 goto bad;
917 }
918 } else {
919 if (copy_flag == 0) {
920 if (data_crc != 0) {
921 ubi_err(ubi, "non-zero data CRC");
922 goto bad;
923 }
924 if (data_size != 0) {
925 ubi_err(ubi, "non-zero data_size");
926 goto bad;
927 }
928 } else {
929 if (data_size == 0) {
930 ubi_err(ubi, "zero data_size of copy");
931 goto bad;
932 }
933 }
934 if (used_ebs != 0) {
935 ubi_err(ubi, "bad used_ebs");
936 goto bad;
937 }
938 }
939
940 return 0;
941
942bad:
943 ubi_err(ubi, "bad VID header");
944 ubi_dump_vid_hdr(vid_hdr);
945 dump_stack();
946 return 1;
947}
948
949
950
951
952
953
954
955
956
957
958
959
960
961
962
963
964int ubi_io_read_vid_hdr(struct ubi_device *ubi, int pnum,
965 struct ubi_vid_io_buf *vidb, int verbose)
966{
967 int err, read_err;
968 uint32_t crc, magic, hdr_crc;
969 struct ubi_vid_hdr *vid_hdr = ubi_get_vid_hdr(vidb);
970 void *p = vidb->buffer;
971
972 dbg_io("read VID header from PEB %d", pnum);
973 ubi_assert(pnum >= 0 && pnum < ubi->peb_count);
974
975 read_err = ubi_io_read(ubi, p, pnum, ubi->vid_hdr_aloffset,
976 ubi->vid_hdr_shift + UBI_VID_HDR_SIZE);
977 if (read_err && read_err != UBI_IO_BITFLIPS && !mtd_is_eccerr(read_err))
978 return read_err;
979
980 magic = be32_to_cpu(vid_hdr->magic);
981 if (magic != UBI_VID_HDR_MAGIC) {
982 if (mtd_is_eccerr(read_err))
983 return UBI_IO_BAD_HDR_EBADMSG;
984
985 if (ubi_check_pattern(vid_hdr, 0xFF, UBI_VID_HDR_SIZE)) {
986 if (verbose)
987 ubi_warn(ubi, "no VID header found at PEB %d, only 0xFF bytes",
988 pnum);
989 dbg_bld("no VID header found at PEB %d, only 0xFF bytes",
990 pnum);
991 if (!read_err)
992 return UBI_IO_FF;
993 else
994 return UBI_IO_FF_BITFLIPS;
995 }
996
997 if (verbose) {
998 ubi_warn(ubi, "bad magic number at PEB %d: %08x instead of %08x",
999 pnum, magic, UBI_VID_HDR_MAGIC);
1000 ubi_dump_vid_hdr(vid_hdr);
1001 }
1002 dbg_bld("bad magic number at PEB %d: %08x instead of %08x",
1003 pnum, magic, UBI_VID_HDR_MAGIC);
1004 return UBI_IO_BAD_HDR;
1005 }
1006
1007 crc = crc32(UBI_CRC32_INIT, vid_hdr, UBI_VID_HDR_SIZE_CRC);
1008 hdr_crc = be32_to_cpu(vid_hdr->hdr_crc);
1009
1010 if (hdr_crc != crc) {
1011 if (verbose) {
1012 ubi_warn(ubi, "bad CRC at PEB %d, calculated %#08x, read %#08x",
1013 pnum, crc, hdr_crc);
1014 ubi_dump_vid_hdr(vid_hdr);
1015 }
1016 dbg_bld("bad CRC at PEB %d, calculated %#08x, read %#08x",
1017 pnum, crc, hdr_crc);
1018 if (!read_err)
1019 return UBI_IO_BAD_HDR;
1020 else
1021 return UBI_IO_BAD_HDR_EBADMSG;
1022 }
1023
1024 err = validate_vid_hdr(ubi, vid_hdr);
1025 if (err) {
1026 ubi_err(ubi, "validation failed for PEB %d", pnum);
1027 return -EINVAL;
1028 }
1029
1030 return read_err ? UBI_IO_BITFLIPS : 0;
1031}
1032
1033
1034
1035
1036
1037
1038
1039
1040
1041
1042
1043
1044
1045
1046
1047
1048int ubi_io_write_vid_hdr(struct ubi_device *ubi, int pnum,
1049 struct ubi_vid_io_buf *vidb)
1050{
1051 struct ubi_vid_hdr *vid_hdr = ubi_get_vid_hdr(vidb);
1052 int err;
1053 uint32_t crc;
1054 void *p = vidb->buffer;
1055
1056 dbg_io("write VID header to PEB %d", pnum);
1057 ubi_assert(pnum >= 0 && pnum < ubi->peb_count);
1058
1059 err = self_check_peb_ec_hdr(ubi, pnum);
1060 if (err)
1061 return err;
1062
1063 vid_hdr->magic = cpu_to_be32(UBI_VID_HDR_MAGIC);
1064 vid_hdr->version = UBI_VERSION;
1065 crc = crc32(UBI_CRC32_INIT, vid_hdr, UBI_VID_HDR_SIZE_CRC);
1066 vid_hdr->hdr_crc = cpu_to_be32(crc);
1067
1068 err = self_check_vid_hdr(ubi, pnum, vid_hdr);
1069 if (err)
1070 return err;
1071
1072 if (ubi_dbg_power_cut(ubi, POWER_CUT_VID_WRITE))
1073 return -EROFS;
1074
1075 err = ubi_io_write(ubi, p, pnum, ubi->vid_hdr_aloffset,
1076 ubi->vid_hdr_alsize);
1077 return err;
1078}
1079
1080
1081
1082
1083
1084
1085
1086
1087
1088static int self_check_not_bad(const struct ubi_device *ubi, int pnum)
1089{
1090 int err;
1091
1092 if (!ubi_dbg_chk_io(ubi))
1093 return 0;
1094
1095 err = ubi_io_is_bad(ubi, pnum);
1096 if (!err)
1097 return err;
1098
1099 ubi_err(ubi, "self-check failed for PEB %d", pnum);
1100 dump_stack();
1101 return err > 0 ? -EINVAL : err;
1102}
1103
1104
1105
1106
1107
1108
1109
1110
1111
1112
1113static int self_check_ec_hdr(const struct ubi_device *ubi, int pnum,
1114 const struct ubi_ec_hdr *ec_hdr)
1115{
1116 int err;
1117 uint32_t magic;
1118
1119 if (!ubi_dbg_chk_io(ubi))
1120 return 0;
1121
1122 magic = be32_to_cpu(ec_hdr->magic);
1123 if (magic != UBI_EC_HDR_MAGIC) {
1124 ubi_err(ubi, "bad magic %#08x, must be %#08x",
1125 magic, UBI_EC_HDR_MAGIC);
1126 goto fail;
1127 }
1128
1129 err = validate_ec_hdr(ubi, ec_hdr);
1130 if (err) {
1131 ubi_err(ubi, "self-check failed for PEB %d", pnum);
1132 goto fail;
1133 }
1134
1135 return 0;
1136
1137fail:
1138 ubi_dump_ec_hdr(ec_hdr);
1139 dump_stack();
1140 return -EINVAL;
1141}
1142
1143
1144
1145
1146
1147
1148
1149
1150
1151static int self_check_peb_ec_hdr(const struct ubi_device *ubi, int pnum)
1152{
1153 int err;
1154 uint32_t crc, hdr_crc;
1155 struct ubi_ec_hdr *ec_hdr;
1156
1157 if (!ubi_dbg_chk_io(ubi))
1158 return 0;
1159
1160 ec_hdr = kzalloc(ubi->ec_hdr_alsize, GFP_NOFS);
1161 if (!ec_hdr)
1162 return -ENOMEM;
1163
1164 err = ubi_io_read(ubi, ec_hdr, pnum, 0, UBI_EC_HDR_SIZE);
1165 if (err && err != UBI_IO_BITFLIPS && !mtd_is_eccerr(err))
1166 goto exit;
1167
1168 crc = crc32(UBI_CRC32_INIT, ec_hdr, UBI_EC_HDR_SIZE_CRC);
1169 hdr_crc = be32_to_cpu(ec_hdr->hdr_crc);
1170 if (hdr_crc != crc) {
1171 ubi_err(ubi, "bad CRC, calculated %#08x, read %#08x",
1172 crc, hdr_crc);
1173 ubi_err(ubi, "self-check failed for PEB %d", pnum);
1174 ubi_dump_ec_hdr(ec_hdr);
1175 dump_stack();
1176 err = -EINVAL;
1177 goto exit;
1178 }
1179
1180 err = self_check_ec_hdr(ubi, pnum, ec_hdr);
1181
1182exit:
1183 kfree(ec_hdr);
1184 return err;
1185}
1186
1187
1188
1189
1190
1191
1192
1193
1194
1195
1196static int self_check_vid_hdr(const struct ubi_device *ubi, int pnum,
1197 const struct ubi_vid_hdr *vid_hdr)
1198{
1199 int err;
1200 uint32_t magic;
1201
1202 if (!ubi_dbg_chk_io(ubi))
1203 return 0;
1204
1205 magic = be32_to_cpu(vid_hdr->magic);
1206 if (magic != UBI_VID_HDR_MAGIC) {
1207 ubi_err(ubi, "bad VID header magic %#08x at PEB %d, must be %#08x",
1208 magic, pnum, UBI_VID_HDR_MAGIC);
1209 goto fail;
1210 }
1211
1212 err = validate_vid_hdr(ubi, vid_hdr);
1213 if (err) {
1214 ubi_err(ubi, "self-check failed for PEB %d", pnum);
1215 goto fail;
1216 }
1217
1218 return err;
1219
1220fail:
1221 ubi_err(ubi, "self-check failed for PEB %d", pnum);
1222 ubi_dump_vid_hdr(vid_hdr);
1223 dump_stack();
1224 return -EINVAL;
1225
1226}
1227
1228
1229
1230
1231
1232
1233
1234
1235
1236static int self_check_peb_vid_hdr(const struct ubi_device *ubi, int pnum)
1237{
1238 int err;
1239 uint32_t crc, hdr_crc;
1240 struct ubi_vid_io_buf *vidb;
1241 struct ubi_vid_hdr *vid_hdr;
1242 void *p;
1243
1244 if (!ubi_dbg_chk_io(ubi))
1245 return 0;
1246
1247 vidb = ubi_alloc_vid_buf(ubi, GFP_NOFS);
1248 if (!vidb)
1249 return -ENOMEM;
1250
1251 vid_hdr = ubi_get_vid_hdr(vidb);
1252 p = vidb->buffer;
1253 err = ubi_io_read(ubi, p, pnum, ubi->vid_hdr_aloffset,
1254 ubi->vid_hdr_alsize);
1255 if (err && err != UBI_IO_BITFLIPS && !mtd_is_eccerr(err))
1256 goto exit;
1257
1258 crc = crc32(UBI_CRC32_INIT, vid_hdr, UBI_VID_HDR_SIZE_CRC);
1259 hdr_crc = be32_to_cpu(vid_hdr->hdr_crc);
1260 if (hdr_crc != crc) {
1261 ubi_err(ubi, "bad VID header CRC at PEB %d, calculated %#08x, read %#08x",
1262 pnum, crc, hdr_crc);
1263 ubi_err(ubi, "self-check failed for PEB %d", pnum);
1264 ubi_dump_vid_hdr(vid_hdr);
1265 dump_stack();
1266 err = -EINVAL;
1267 goto exit;
1268 }
1269
1270 err = self_check_vid_hdr(ubi, pnum, vid_hdr);
1271
1272exit:
1273 ubi_free_vid_buf(vidb);
1274 return err;
1275}
1276
1277
1278
1279
1280
1281
1282
1283
1284
1285
1286
1287
1288
1289static int self_check_write(struct ubi_device *ubi, const void *buf, int pnum,
1290 int offset, int len)
1291{
1292 int err, i;
1293 size_t read;
1294 void *buf1;
1295 loff_t addr = (loff_t)pnum * ubi->peb_size + offset;
1296
1297 if (!ubi_dbg_chk_io(ubi))
1298 return 0;
1299
1300 buf1 = __vmalloc(len, GFP_NOFS);
1301 if (!buf1) {
1302 ubi_err(ubi, "cannot allocate memory to check writes");
1303 return 0;
1304 }
1305
1306 err = mtd_read(ubi->mtd, addr, len, &read, buf1);
1307 if (err && !mtd_is_bitflip(err))
1308 goto out_free;
1309
1310 for (i = 0; i < len; i++) {
1311 uint8_t c = ((uint8_t *)buf)[i];
1312 uint8_t c1 = ((uint8_t *)buf1)[i];
1313 int dump_len;
1314
1315 if (c == c1)
1316 continue;
1317
1318 ubi_err(ubi, "self-check failed for PEB %d:%d, len %d",
1319 pnum, offset, len);
1320 ubi_msg(ubi, "data differ at position %d", i);
1321 dump_len = max_t(int, 128, len - i);
1322 ubi_msg(ubi, "hex dump of the original buffer from %d to %d",
1323 i, i + dump_len);
1324 print_hex_dump(KERN_DEBUG, "", DUMP_PREFIX_OFFSET, 32, 1,
1325 buf + i, dump_len, 1);
1326 ubi_msg(ubi, "hex dump of the read buffer from %d to %d",
1327 i, i + dump_len);
1328 print_hex_dump(KERN_DEBUG, "", DUMP_PREFIX_OFFSET, 32, 1,
1329 buf1 + i, dump_len, 1);
1330 dump_stack();
1331 err = -EINVAL;
1332 goto out_free;
1333 }
1334
1335 vfree(buf1);
1336 return 0;
1337
1338out_free:
1339 vfree(buf1);
1340 return err;
1341}
1342
1343
1344
1345
1346
1347
1348
1349
1350
1351
1352
1353
1354int ubi_self_check_all_ff(struct ubi_device *ubi, int pnum, int offset, int len)
1355{
1356 size_t read;
1357 int err;
1358 void *buf;
1359 loff_t addr = (loff_t)pnum * ubi->peb_size + offset;
1360
1361 if (!ubi_dbg_chk_io(ubi))
1362 return 0;
1363
1364 buf = __vmalloc(len, GFP_NOFS);
1365 if (!buf) {
1366 ubi_err(ubi, "cannot allocate memory to check for 0xFFs");
1367 return 0;
1368 }
1369
1370 err = mtd_read(ubi->mtd, addr, len, &read, buf);
1371 if (err && !mtd_is_bitflip(err)) {
1372 ubi_err(ubi, "err %d while reading %d bytes from PEB %d:%d, read %zd bytes",
1373 err, len, pnum, offset, read);
1374 goto error;
1375 }
1376
1377 err = ubi_check_pattern(buf, 0xFF, len);
1378 if (err == 0) {
1379 ubi_err(ubi, "flash region at PEB %d:%d, length %d does not contain all 0xFF bytes",
1380 pnum, offset, len);
1381 goto fail;
1382 }
1383
1384 vfree(buf);
1385 return 0;
1386
1387fail:
1388 ubi_err(ubi, "self-check failed for PEB %d", pnum);
1389 ubi_msg(ubi, "hex dump of the %d-%d region", offset, offset + len);
1390 print_hex_dump(KERN_DEBUG, "", DUMP_PREFIX_OFFSET, 32, 1, buf, len, 1);
1391 err = -EINVAL;
1392error:
1393 dump_stack();
1394 vfree(buf);
1395 return err;
1396}
1397