This source file includes following definitions.
- ubi_next_sqnum
- ubi_get_compat
- ubi_eba_get_ldesc
- ubi_eba_create_table
- ubi_eba_destroy_table
- ubi_eba_copy_table
- ubi_eba_replace_table
- ltree_lookup
- ltree_add_entry
- leb_read_lock
- leb_read_unlock
- leb_write_lock
- leb_write_trylock
- leb_write_unlock
- ubi_eba_is_mapped
- ubi_eba_unmap_leb
- check_mapping
- check_mapping
- ubi_eba_read_leb
- ubi_eba_read_leb_sg
- try_recover_peb
- recover_peb
- try_write_vid_and_data
- ubi_eba_write_leb
- ubi_eba_write_leb_st
- ubi_eba_atomic_leb_change
- is_error_sane
- ubi_eba_copy_leb
- print_rsvd_warning
- self_check_eba
- ubi_eba_init
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 #include <linux/slab.h>
32 #include <linux/crc32.h>
33 #include <linux/err.h>
34 #include "ubi.h"
35
36
37 #define EBA_RESERVED_PEBS 1
38
39
40
41
42
43
44
45
46
47 struct ubi_eba_entry {
48 int pnum;
49 };
50
51
52
53
54
55
56
57
58
59 struct ubi_eba_table {
60 struct ubi_eba_entry *entries;
61 };
62
63
64
65
66
67
68
69
70
71 unsigned long long ubi_next_sqnum(struct ubi_device *ubi)
72 {
73 unsigned long long sqnum;
74
75 spin_lock(&ubi->ltree_lock);
76 sqnum = ubi->global_sqnum++;
77 spin_unlock(&ubi->ltree_lock);
78
79 return sqnum;
80 }
81
82
83
84
85
86
87
88
89
90 static int ubi_get_compat(const struct ubi_device *ubi, int vol_id)
91 {
92 if (vol_id == UBI_LAYOUT_VOLUME_ID)
93 return UBI_LAYOUT_VOLUME_COMPAT;
94 return 0;
95 }
96
97
98
99
100
101
102
103
104
105
106
107 void ubi_eba_get_ldesc(struct ubi_volume *vol, int lnum,
108 struct ubi_eba_leb_desc *ldesc)
109 {
110 ldesc->lnum = lnum;
111 ldesc->pnum = vol->eba_tbl->entries[lnum].pnum;
112 }
113
114
115
116
117
118
119
120
121
122
123 struct ubi_eba_table *ubi_eba_create_table(struct ubi_volume *vol,
124 int nentries)
125 {
126 struct ubi_eba_table *tbl;
127 int err = -ENOMEM;
128 int i;
129
130 tbl = kzalloc(sizeof(*tbl), GFP_KERNEL);
131 if (!tbl)
132 return ERR_PTR(-ENOMEM);
133
134 tbl->entries = kmalloc_array(nentries, sizeof(*tbl->entries),
135 GFP_KERNEL);
136 if (!tbl->entries)
137 goto err;
138
139 for (i = 0; i < nentries; i++)
140 tbl->entries[i].pnum = UBI_LEB_UNMAPPED;
141
142 return tbl;
143
144 err:
145 kfree(tbl->entries);
146 kfree(tbl);
147
148 return ERR_PTR(err);
149 }
150
151
152
153
154
155
156
157 void ubi_eba_destroy_table(struct ubi_eba_table *tbl)
158 {
159 if (!tbl)
160 return;
161
162 kfree(tbl->entries);
163 kfree(tbl);
164 }
165
166
167
168
169
170
171
172
173
174 void ubi_eba_copy_table(struct ubi_volume *vol, struct ubi_eba_table *dst,
175 int nentries)
176 {
177 struct ubi_eba_table *src;
178 int i;
179
180 ubi_assert(dst && vol && vol->eba_tbl);
181
182 src = vol->eba_tbl;
183
184 for (i = 0; i < nentries; i++)
185 dst->entries[i].pnum = src->entries[i].pnum;
186 }
187
188
189
190
191
192
193
194
195 void ubi_eba_replace_table(struct ubi_volume *vol, struct ubi_eba_table *tbl)
196 {
197 ubi_eba_destroy_table(vol->eba_tbl);
198 vol->eba_tbl = tbl;
199 }
200
201
202
203
204
205
206
207
208
209
210
211 static struct ubi_ltree_entry *ltree_lookup(struct ubi_device *ubi, int vol_id,
212 int lnum)
213 {
214 struct rb_node *p;
215
216 p = ubi->ltree.rb_node;
217 while (p) {
218 struct ubi_ltree_entry *le;
219
220 le = rb_entry(p, struct ubi_ltree_entry, rb);
221
222 if (vol_id < le->vol_id)
223 p = p->rb_left;
224 else if (vol_id > le->vol_id)
225 p = p->rb_right;
226 else {
227 if (lnum < le->lnum)
228 p = p->rb_left;
229 else if (lnum > le->lnum)
230 p = p->rb_right;
231 else
232 return le;
233 }
234 }
235
236 return NULL;
237 }
238
239
240
241
242
243
244
245
246
247
248
249
250 static struct ubi_ltree_entry *ltree_add_entry(struct ubi_device *ubi,
251 int vol_id, int lnum)
252 {
253 struct ubi_ltree_entry *le, *le1, *le_free;
254
255 le = kmalloc(sizeof(struct ubi_ltree_entry), GFP_NOFS);
256 if (!le)
257 return ERR_PTR(-ENOMEM);
258
259 le->users = 0;
260 init_rwsem(&le->mutex);
261 le->vol_id = vol_id;
262 le->lnum = lnum;
263
264 spin_lock(&ubi->ltree_lock);
265 le1 = ltree_lookup(ubi, vol_id, lnum);
266
267 if (le1) {
268
269
270
271
272 le_free = le;
273 le = le1;
274 } else {
275 struct rb_node **p, *parent = NULL;
276
277
278
279
280
281 le_free = NULL;
282
283 p = &ubi->ltree.rb_node;
284 while (*p) {
285 parent = *p;
286 le1 = rb_entry(parent, struct ubi_ltree_entry, rb);
287
288 if (vol_id < le1->vol_id)
289 p = &(*p)->rb_left;
290 else if (vol_id > le1->vol_id)
291 p = &(*p)->rb_right;
292 else {
293 ubi_assert(lnum != le1->lnum);
294 if (lnum < le1->lnum)
295 p = &(*p)->rb_left;
296 else
297 p = &(*p)->rb_right;
298 }
299 }
300
301 rb_link_node(&le->rb, parent, p);
302 rb_insert_color(&le->rb, &ubi->ltree);
303 }
304 le->users += 1;
305 spin_unlock(&ubi->ltree_lock);
306
307 kfree(le_free);
308 return le;
309 }
310
311
312
313
314
315
316
317
318
319
320 static int leb_read_lock(struct ubi_device *ubi, int vol_id, int lnum)
321 {
322 struct ubi_ltree_entry *le;
323
324 le = ltree_add_entry(ubi, vol_id, lnum);
325 if (IS_ERR(le))
326 return PTR_ERR(le);
327 down_read(&le->mutex);
328 return 0;
329 }
330
331
332
333
334
335
336
337 static void leb_read_unlock(struct ubi_device *ubi, int vol_id, int lnum)
338 {
339 struct ubi_ltree_entry *le;
340
341 spin_lock(&ubi->ltree_lock);
342 le = ltree_lookup(ubi, vol_id, lnum);
343 le->users -= 1;
344 ubi_assert(le->users >= 0);
345 up_read(&le->mutex);
346 if (le->users == 0) {
347 rb_erase(&le->rb, &ubi->ltree);
348 kfree(le);
349 }
350 spin_unlock(&ubi->ltree_lock);
351 }
352
353
354
355
356
357
358
359
360
361
362 static int leb_write_lock(struct ubi_device *ubi, int vol_id, int lnum)
363 {
364 struct ubi_ltree_entry *le;
365
366 le = ltree_add_entry(ubi, vol_id, lnum);
367 if (IS_ERR(le))
368 return PTR_ERR(le);
369 down_write(&le->mutex);
370 return 0;
371 }
372
373
374
375
376
377
378
379
380
381
382
383
384 static int leb_write_trylock(struct ubi_device *ubi, int vol_id, int lnum)
385 {
386 struct ubi_ltree_entry *le;
387
388 le = ltree_add_entry(ubi, vol_id, lnum);
389 if (IS_ERR(le))
390 return PTR_ERR(le);
391 if (down_write_trylock(&le->mutex))
392 return 0;
393
394
395 spin_lock(&ubi->ltree_lock);
396 le->users -= 1;
397 ubi_assert(le->users >= 0);
398 if (le->users == 0) {
399 rb_erase(&le->rb, &ubi->ltree);
400 kfree(le);
401 }
402 spin_unlock(&ubi->ltree_lock);
403
404 return 1;
405 }
406
407
408
409
410
411
412
413 static void leb_write_unlock(struct ubi_device *ubi, int vol_id, int lnum)
414 {
415 struct ubi_ltree_entry *le;
416
417 spin_lock(&ubi->ltree_lock);
418 le = ltree_lookup(ubi, vol_id, lnum);
419 le->users -= 1;
420 ubi_assert(le->users >= 0);
421 up_write(&le->mutex);
422 if (le->users == 0) {
423 rb_erase(&le->rb, &ubi->ltree);
424 kfree(le);
425 }
426 spin_unlock(&ubi->ltree_lock);
427 }
428
429
430
431
432
433
434
435
436 bool ubi_eba_is_mapped(struct ubi_volume *vol, int lnum)
437 {
438 return vol->eba_tbl->entries[lnum].pnum >= 0;
439 }
440
441
442
443
444
445
446
447
448
449
450
451 int ubi_eba_unmap_leb(struct ubi_device *ubi, struct ubi_volume *vol,
452 int lnum)
453 {
454 int err, pnum, vol_id = vol->vol_id;
455
456 if (ubi->ro_mode)
457 return -EROFS;
458
459 err = leb_write_lock(ubi, vol_id, lnum);
460 if (err)
461 return err;
462
463 pnum = vol->eba_tbl->entries[lnum].pnum;
464 if (pnum < 0)
465
466 goto out_unlock;
467
468 dbg_eba("erase LEB %d:%d, PEB %d", vol_id, lnum, pnum);
469
470 down_read(&ubi->fm_eba_sem);
471 vol->eba_tbl->entries[lnum].pnum = UBI_LEB_UNMAPPED;
472 up_read(&ubi->fm_eba_sem);
473 err = ubi_wl_put_peb(ubi, vol_id, lnum, pnum, 0);
474
475 out_unlock:
476 leb_write_unlock(ubi, vol_id, lnum);
477 return err;
478 }
479
480 #ifdef CONFIG_MTD_UBI_FASTMAP
481
482
483
484
485
486
487
488
489
490
491
492
493
494
495
496
497
498 static int check_mapping(struct ubi_device *ubi, struct ubi_volume *vol, int lnum,
499 int *pnum)
500 {
501 int err;
502 struct ubi_vid_io_buf *vidb;
503 struct ubi_vid_hdr *vid_hdr;
504
505 if (!ubi->fast_attach)
506 return 0;
507
508 if (!vol->checkmap || test_bit(lnum, vol->checkmap))
509 return 0;
510
511 vidb = ubi_alloc_vid_buf(ubi, GFP_NOFS);
512 if (!vidb)
513 return -ENOMEM;
514
515 err = ubi_io_read_vid_hdr(ubi, *pnum, vidb, 0);
516 if (err > 0 && err != UBI_IO_BITFLIPS) {
517 int torture = 0;
518
519 switch (err) {
520 case UBI_IO_FF:
521 case UBI_IO_FF_BITFLIPS:
522 case UBI_IO_BAD_HDR:
523 case UBI_IO_BAD_HDR_EBADMSG:
524 break;
525 default:
526 ubi_assert(0);
527 }
528
529 if (err == UBI_IO_BAD_HDR_EBADMSG || err == UBI_IO_FF_BITFLIPS)
530 torture = 1;
531
532 down_read(&ubi->fm_eba_sem);
533 vol->eba_tbl->entries[lnum].pnum = UBI_LEB_UNMAPPED;
534 up_read(&ubi->fm_eba_sem);
535 ubi_wl_put_peb(ubi, vol->vol_id, lnum, *pnum, torture);
536
537 *pnum = UBI_LEB_UNMAPPED;
538 } else if (err < 0) {
539 ubi_err(ubi, "unable to read VID header back from PEB %i: %i",
540 *pnum, err);
541
542 goto out_free;
543 } else {
544 int found_vol_id, found_lnum;
545
546 ubi_assert(err == 0 || err == UBI_IO_BITFLIPS);
547
548 vid_hdr = ubi_get_vid_hdr(vidb);
549 found_vol_id = be32_to_cpu(vid_hdr->vol_id);
550 found_lnum = be32_to_cpu(vid_hdr->lnum);
551
552 if (found_lnum != lnum || found_vol_id != vol->vol_id) {
553 ubi_err(ubi, "EBA mismatch! PEB %i is LEB %i:%i instead of LEB %i:%i",
554 *pnum, found_vol_id, found_lnum, vol->vol_id, lnum);
555 ubi_ro_mode(ubi);
556 err = -EINVAL;
557 goto out_free;
558 }
559 }
560
561 set_bit(lnum, vol->checkmap);
562 err = 0;
563
564 out_free:
565 ubi_free_vid_buf(vidb);
566
567 return err;
568 }
569 #else
570 static int check_mapping(struct ubi_device *ubi, struct ubi_volume *vol, int lnum,
571 int *pnum)
572 {
573 return 0;
574 }
575 #endif
576
577
578
579
580
581
582
583
584
585
586
587
588
589
590
591
592
593
594
595
596 int ubi_eba_read_leb(struct ubi_device *ubi, struct ubi_volume *vol, int lnum,
597 void *buf, int offset, int len, int check)
598 {
599 int err, pnum, scrub = 0, vol_id = vol->vol_id;
600 struct ubi_vid_io_buf *vidb;
601 struct ubi_vid_hdr *vid_hdr;
602 uint32_t uninitialized_var(crc);
603
604 err = leb_read_lock(ubi, vol_id, lnum);
605 if (err)
606 return err;
607
608 pnum = vol->eba_tbl->entries[lnum].pnum;
609 if (pnum >= 0) {
610 err = check_mapping(ubi, vol, lnum, &pnum);
611 if (err < 0)
612 goto out_unlock;
613 }
614
615 if (pnum == UBI_LEB_UNMAPPED) {
616
617
618
619
620
621 dbg_eba("read %d bytes from offset %d of LEB %d:%d (unmapped)",
622 len, offset, vol_id, lnum);
623 leb_read_unlock(ubi, vol_id, lnum);
624 ubi_assert(vol->vol_type != UBI_STATIC_VOLUME);
625 memset(buf, 0xFF, len);
626 return 0;
627 }
628
629 dbg_eba("read %d bytes from offset %d of LEB %d:%d, PEB %d",
630 len, offset, vol_id, lnum, pnum);
631
632 if (vol->vol_type == UBI_DYNAMIC_VOLUME)
633 check = 0;
634
635 retry:
636 if (check) {
637 vidb = ubi_alloc_vid_buf(ubi, GFP_NOFS);
638 if (!vidb) {
639 err = -ENOMEM;
640 goto out_unlock;
641 }
642
643 vid_hdr = ubi_get_vid_hdr(vidb);
644
645 err = ubi_io_read_vid_hdr(ubi, pnum, vidb, 1);
646 if (err && err != UBI_IO_BITFLIPS) {
647 if (err > 0) {
648
649
650
651
652
653
654
655
656 if (err == UBI_IO_BAD_HDR_EBADMSG ||
657 err == UBI_IO_BAD_HDR) {
658 ubi_warn(ubi, "corrupted VID header at PEB %d, LEB %d:%d",
659 pnum, vol_id, lnum);
660 err = -EBADMSG;
661 } else {
662
663
664
665
666
667
668
669
670
671
672
673
674
675 if (ubi->fast_attach) {
676 err = -EBADMSG;
677 } else {
678 err = -EINVAL;
679 ubi_ro_mode(ubi);
680 }
681 }
682 }
683 goto out_free;
684 } else if (err == UBI_IO_BITFLIPS)
685 scrub = 1;
686
687 ubi_assert(lnum < be32_to_cpu(vid_hdr->used_ebs));
688 ubi_assert(len == be32_to_cpu(vid_hdr->data_size));
689
690 crc = be32_to_cpu(vid_hdr->data_crc);
691 ubi_free_vid_buf(vidb);
692 }
693
694 err = ubi_io_read_data(ubi, buf, pnum, offset, len);
695 if (err) {
696 if (err == UBI_IO_BITFLIPS)
697 scrub = 1;
698 else if (mtd_is_eccerr(err)) {
699 if (vol->vol_type == UBI_DYNAMIC_VOLUME)
700 goto out_unlock;
701 scrub = 1;
702 if (!check) {
703 ubi_msg(ubi, "force data checking");
704 check = 1;
705 goto retry;
706 }
707 } else
708 goto out_unlock;
709 }
710
711 if (check) {
712 uint32_t crc1 = crc32(UBI_CRC32_INIT, buf, len);
713 if (crc1 != crc) {
714 ubi_warn(ubi, "CRC error: calculated %#08x, must be %#08x",
715 crc1, crc);
716 err = -EBADMSG;
717 goto out_unlock;
718 }
719 }
720
721 if (scrub)
722 err = ubi_wl_scrub_peb(ubi, pnum);
723
724 leb_read_unlock(ubi, vol_id, lnum);
725 return err;
726
727 out_free:
728 ubi_free_vid_buf(vidb);
729 out_unlock:
730 leb_read_unlock(ubi, vol_id, lnum);
731 return err;
732 }
733
734
735
736
737
738
739
740
741
742
743
744
745
746
747
748 int ubi_eba_read_leb_sg(struct ubi_device *ubi, struct ubi_volume *vol,
749 struct ubi_sgl *sgl, int lnum, int offset, int len,
750 int check)
751 {
752 int to_read;
753 int ret;
754 struct scatterlist *sg;
755
756 for (;;) {
757 ubi_assert(sgl->list_pos < UBI_MAX_SG_COUNT);
758 sg = &sgl->sg[sgl->list_pos];
759 if (len < sg->length - sgl->page_pos)
760 to_read = len;
761 else
762 to_read = sg->length - sgl->page_pos;
763
764 ret = ubi_eba_read_leb(ubi, vol, lnum,
765 sg_virt(sg) + sgl->page_pos, offset,
766 to_read, check);
767 if (ret < 0)
768 return ret;
769
770 offset += to_read;
771 len -= to_read;
772 if (!len) {
773 sgl->page_pos += to_read;
774 if (sgl->page_pos == sg->length) {
775 sgl->list_pos++;
776 sgl->page_pos = 0;
777 }
778
779 break;
780 }
781
782 sgl->list_pos++;
783 sgl->page_pos = 0;
784 }
785
786 return ret;
787 }
788
789
790
791
792
793
794
795
796
797
798
799
800
801
802
803
804
805
806
807 static int try_recover_peb(struct ubi_volume *vol, int pnum, int lnum,
808 const void *buf, int offset, int len,
809 struct ubi_vid_io_buf *vidb, bool *retry)
810 {
811 struct ubi_device *ubi = vol->ubi;
812 struct ubi_vid_hdr *vid_hdr;
813 int new_pnum, err, vol_id = vol->vol_id, data_size;
814 uint32_t crc;
815
816 *retry = false;
817
818 new_pnum = ubi_wl_get_peb(ubi);
819 if (new_pnum < 0) {
820 err = new_pnum;
821 goto out_put;
822 }
823
824 ubi_msg(ubi, "recover PEB %d, move data to PEB %d",
825 pnum, new_pnum);
826
827 err = ubi_io_read_vid_hdr(ubi, pnum, vidb, 1);
828 if (err && err != UBI_IO_BITFLIPS) {
829 if (err > 0)
830 err = -EIO;
831 goto out_put;
832 }
833
834 vid_hdr = ubi_get_vid_hdr(vidb);
835 ubi_assert(vid_hdr->vol_type == UBI_VID_DYNAMIC);
836
837 mutex_lock(&ubi->buf_mutex);
838 memset(ubi->peb_buf + offset, 0xFF, len);
839
840
841 if (offset > 0) {
842 err = ubi_io_read_data(ubi, ubi->peb_buf, pnum, 0, offset);
843 if (err && err != UBI_IO_BITFLIPS)
844 goto out_unlock;
845 }
846
847 *retry = true;
848
849 memcpy(ubi->peb_buf + offset, buf, len);
850
851 data_size = offset + len;
852 crc = crc32(UBI_CRC32_INIT, ubi->peb_buf, data_size);
853 vid_hdr->sqnum = cpu_to_be64(ubi_next_sqnum(ubi));
854 vid_hdr->copy_flag = 1;
855 vid_hdr->data_size = cpu_to_be32(data_size);
856 vid_hdr->data_crc = cpu_to_be32(crc);
857 err = ubi_io_write_vid_hdr(ubi, new_pnum, vidb);
858 if (err)
859 goto out_unlock;
860
861 err = ubi_io_write_data(ubi, ubi->peb_buf, new_pnum, 0, data_size);
862
863 out_unlock:
864 mutex_unlock(&ubi->buf_mutex);
865
866 if (!err)
867 vol->eba_tbl->entries[lnum].pnum = new_pnum;
868
869 out_put:
870 up_read(&ubi->fm_eba_sem);
871
872 if (!err) {
873 ubi_wl_put_peb(ubi, vol_id, lnum, pnum, 1);
874 ubi_msg(ubi, "data was successfully recovered");
875 } else if (new_pnum >= 0) {
876
877
878
879
880 ubi_wl_put_peb(ubi, vol_id, lnum, new_pnum, 1);
881 ubi_warn(ubi, "failed to write to PEB %d", new_pnum);
882 }
883
884 return err;
885 }
886
887
888
889
890
891
892
893
894
895
896
897
898
899
900
901
902
903 static int recover_peb(struct ubi_device *ubi, int pnum, int vol_id, int lnum,
904 const void *buf, int offset, int len)
905 {
906 int err, idx = vol_id2idx(ubi, vol_id), tries;
907 struct ubi_volume *vol = ubi->volumes[idx];
908 struct ubi_vid_io_buf *vidb;
909
910 vidb = ubi_alloc_vid_buf(ubi, GFP_NOFS);
911 if (!vidb)
912 return -ENOMEM;
913
914 for (tries = 0; tries <= UBI_IO_RETRIES; tries++) {
915 bool retry;
916
917 err = try_recover_peb(vol, pnum, lnum, buf, offset, len, vidb,
918 &retry);
919 if (!err || !retry)
920 break;
921
922 ubi_msg(ubi, "try again");
923 }
924
925 ubi_free_vid_buf(vidb);
926
927 return err;
928 }
929
930
931
932
933
934
935
936
937
938
939
940
941
942
943
944
945 static int try_write_vid_and_data(struct ubi_volume *vol, int lnum,
946 struct ubi_vid_io_buf *vidb, const void *buf,
947 int offset, int len)
948 {
949 struct ubi_device *ubi = vol->ubi;
950 int pnum, opnum, err, vol_id = vol->vol_id;
951
952 pnum = ubi_wl_get_peb(ubi);
953 if (pnum < 0) {
954 err = pnum;
955 goto out_put;
956 }
957
958 opnum = vol->eba_tbl->entries[lnum].pnum;
959
960 dbg_eba("write VID hdr and %d bytes at offset %d of LEB %d:%d, PEB %d",
961 len, offset, vol_id, lnum, pnum);
962
963 err = ubi_io_write_vid_hdr(ubi, pnum, vidb);
964 if (err) {
965 ubi_warn(ubi, "failed to write VID header to LEB %d:%d, PEB %d",
966 vol_id, lnum, pnum);
967 goto out_put;
968 }
969
970 if (len) {
971 err = ubi_io_write_data(ubi, buf, pnum, offset, len);
972 if (err) {
973 ubi_warn(ubi,
974 "failed to write %d bytes at offset %d of LEB %d:%d, PEB %d",
975 len, offset, vol_id, lnum, pnum);
976 goto out_put;
977 }
978 }
979
980 vol->eba_tbl->entries[lnum].pnum = pnum;
981
982 out_put:
983 up_read(&ubi->fm_eba_sem);
984
985 if (err && pnum >= 0)
986 err = ubi_wl_put_peb(ubi, vol_id, lnum, pnum, 1);
987 else if (!err && opnum >= 0)
988 err = ubi_wl_put_peb(ubi, vol_id, lnum, opnum, 0);
989
990 return err;
991 }
992
993
994
995
996
997
998
999
1000
1001
1002
1003
1004
1005
1006
1007
1008 int ubi_eba_write_leb(struct ubi_device *ubi, struct ubi_volume *vol, int lnum,
1009 const void *buf, int offset, int len)
1010 {
1011 int err, pnum, tries, vol_id = vol->vol_id;
1012 struct ubi_vid_io_buf *vidb;
1013 struct ubi_vid_hdr *vid_hdr;
1014
1015 if (ubi->ro_mode)
1016 return -EROFS;
1017
1018 err = leb_write_lock(ubi, vol_id, lnum);
1019 if (err)
1020 return err;
1021
1022 pnum = vol->eba_tbl->entries[lnum].pnum;
1023 if (pnum >= 0) {
1024 err = check_mapping(ubi, vol, lnum, &pnum);
1025 if (err < 0)
1026 goto out;
1027 }
1028
1029 if (pnum >= 0) {
1030 dbg_eba("write %d bytes at offset %d of LEB %d:%d, PEB %d",
1031 len, offset, vol_id, lnum, pnum);
1032
1033 err = ubi_io_write_data(ubi, buf, pnum, offset, len);
1034 if (err) {
1035 ubi_warn(ubi, "failed to write data to PEB %d", pnum);
1036 if (err == -EIO && ubi->bad_allowed)
1037 err = recover_peb(ubi, pnum, vol_id, lnum, buf,
1038 offset, len);
1039 }
1040
1041 goto out;
1042 }
1043
1044
1045
1046
1047
1048 vidb = ubi_alloc_vid_buf(ubi, GFP_NOFS);
1049 if (!vidb) {
1050 leb_write_unlock(ubi, vol_id, lnum);
1051 return -ENOMEM;
1052 }
1053
1054 vid_hdr = ubi_get_vid_hdr(vidb);
1055
1056 vid_hdr->vol_type = UBI_VID_DYNAMIC;
1057 vid_hdr->sqnum = cpu_to_be64(ubi_next_sqnum(ubi));
1058 vid_hdr->vol_id = cpu_to_be32(vol_id);
1059 vid_hdr->lnum = cpu_to_be32(lnum);
1060 vid_hdr->compat = ubi_get_compat(ubi, vol_id);
1061 vid_hdr->data_pad = cpu_to_be32(vol->data_pad);
1062
1063 for (tries = 0; tries <= UBI_IO_RETRIES; tries++) {
1064 err = try_write_vid_and_data(vol, lnum, vidb, buf, offset, len);
1065 if (err != -EIO || !ubi->bad_allowed)
1066 break;
1067
1068
1069
1070
1071
1072
1073
1074 vid_hdr->sqnum = cpu_to_be64(ubi_next_sqnum(ubi));
1075 ubi_msg(ubi, "try another PEB");
1076 }
1077
1078 ubi_free_vid_buf(vidb);
1079
1080 out:
1081 if (err)
1082 ubi_ro_mode(ubi);
1083
1084 leb_write_unlock(ubi, vol_id, lnum);
1085
1086 return err;
1087 }
1088
1089
1090
1091
1092
1093
1094
1095
1096
1097
1098
1099
1100
1101
1102
1103
1104
1105
1106
1107
1108
1109
1110
1111 int ubi_eba_write_leb_st(struct ubi_device *ubi, struct ubi_volume *vol,
1112 int lnum, const void *buf, int len, int used_ebs)
1113 {
1114 int err, tries, data_size = len, vol_id = vol->vol_id;
1115 struct ubi_vid_io_buf *vidb;
1116 struct ubi_vid_hdr *vid_hdr;
1117 uint32_t crc;
1118
1119 if (ubi->ro_mode)
1120 return -EROFS;
1121
1122 if (lnum == used_ebs - 1)
1123
1124 len = ALIGN(data_size, ubi->min_io_size);
1125 else
1126 ubi_assert(!(len & (ubi->min_io_size - 1)));
1127
1128 vidb = ubi_alloc_vid_buf(ubi, GFP_NOFS);
1129 if (!vidb)
1130 return -ENOMEM;
1131
1132 vid_hdr = ubi_get_vid_hdr(vidb);
1133
1134 err = leb_write_lock(ubi, vol_id, lnum);
1135 if (err)
1136 goto out;
1137
1138 vid_hdr->sqnum = cpu_to_be64(ubi_next_sqnum(ubi));
1139 vid_hdr->vol_id = cpu_to_be32(vol_id);
1140 vid_hdr->lnum = cpu_to_be32(lnum);
1141 vid_hdr->compat = ubi_get_compat(ubi, vol_id);
1142 vid_hdr->data_pad = cpu_to_be32(vol->data_pad);
1143
1144 crc = crc32(UBI_CRC32_INIT, buf, data_size);
1145 vid_hdr->vol_type = UBI_VID_STATIC;
1146 vid_hdr->data_size = cpu_to_be32(data_size);
1147 vid_hdr->used_ebs = cpu_to_be32(used_ebs);
1148 vid_hdr->data_crc = cpu_to_be32(crc);
1149
1150 ubi_assert(vol->eba_tbl->entries[lnum].pnum < 0);
1151
1152 for (tries = 0; tries <= UBI_IO_RETRIES; tries++) {
1153 err = try_write_vid_and_data(vol, lnum, vidb, buf, 0, len);
1154 if (err != -EIO || !ubi->bad_allowed)
1155 break;
1156
1157 vid_hdr->sqnum = cpu_to_be64(ubi_next_sqnum(ubi));
1158 ubi_msg(ubi, "try another PEB");
1159 }
1160
1161 if (err)
1162 ubi_ro_mode(ubi);
1163
1164 leb_write_unlock(ubi, vol_id, lnum);
1165
1166 out:
1167 ubi_free_vid_buf(vidb);
1168
1169 return err;
1170 }
1171
1172
1173
1174
1175
1176
1177
1178
1179
1180
1181
1182
1183
1184
1185
1186
1187
1188
1189 int ubi_eba_atomic_leb_change(struct ubi_device *ubi, struct ubi_volume *vol,
1190 int lnum, const void *buf, int len)
1191 {
1192 int err, tries, vol_id = vol->vol_id;
1193 struct ubi_vid_io_buf *vidb;
1194 struct ubi_vid_hdr *vid_hdr;
1195 uint32_t crc;
1196
1197 if (ubi->ro_mode)
1198 return -EROFS;
1199
1200 if (len == 0) {
1201
1202
1203
1204
1205 err = ubi_eba_unmap_leb(ubi, vol, lnum);
1206 if (err)
1207 return err;
1208 return ubi_eba_write_leb(ubi, vol, lnum, NULL, 0, 0);
1209 }
1210
1211 vidb = ubi_alloc_vid_buf(ubi, GFP_NOFS);
1212 if (!vidb)
1213 return -ENOMEM;
1214
1215 vid_hdr = ubi_get_vid_hdr(vidb);
1216
1217 mutex_lock(&ubi->alc_mutex);
1218 err = leb_write_lock(ubi, vol_id, lnum);
1219 if (err)
1220 goto out_mutex;
1221
1222 vid_hdr->sqnum = cpu_to_be64(ubi_next_sqnum(ubi));
1223 vid_hdr->vol_id = cpu_to_be32(vol_id);
1224 vid_hdr->lnum = cpu_to_be32(lnum);
1225 vid_hdr->compat = ubi_get_compat(ubi, vol_id);
1226 vid_hdr->data_pad = cpu_to_be32(vol->data_pad);
1227
1228 crc = crc32(UBI_CRC32_INIT, buf, len);
1229 vid_hdr->vol_type = UBI_VID_DYNAMIC;
1230 vid_hdr->data_size = cpu_to_be32(len);
1231 vid_hdr->copy_flag = 1;
1232 vid_hdr->data_crc = cpu_to_be32(crc);
1233
1234 dbg_eba("change LEB %d:%d", vol_id, lnum);
1235
1236 for (tries = 0; tries <= UBI_IO_RETRIES; tries++) {
1237 err = try_write_vid_and_data(vol, lnum, vidb, buf, 0, len);
1238 if (err != -EIO || !ubi->bad_allowed)
1239 break;
1240
1241 vid_hdr->sqnum = cpu_to_be64(ubi_next_sqnum(ubi));
1242 ubi_msg(ubi, "try another PEB");
1243 }
1244
1245
1246
1247
1248
1249
1250 if (err)
1251 ubi_ro_mode(ubi);
1252
1253 leb_write_unlock(ubi, vol_id, lnum);
1254
1255 out_mutex:
1256 mutex_unlock(&ubi->alc_mutex);
1257 ubi_free_vid_buf(vidb);
1258 return err;
1259 }
1260
1261
1262
1263
1264
1265
1266
1267
1268
1269
1270
1271
1272
1273
1274
1275
1276
1277
1278
1279
1280 static int is_error_sane(int err)
1281 {
1282 if (err == -EIO || err == -ENOMEM || err == UBI_IO_BAD_HDR ||
1283 err == UBI_IO_BAD_HDR_EBADMSG || err == -ETIMEDOUT)
1284 return 0;
1285 return 1;
1286 }
1287
1288
1289
1290
1291
1292
1293
1294
1295
1296
1297
1298
1299
1300
1301
1302 int ubi_eba_copy_leb(struct ubi_device *ubi, int from, int to,
1303 struct ubi_vid_io_buf *vidb)
1304 {
1305 int err, vol_id, lnum, data_size, aldata_size, idx;
1306 struct ubi_vid_hdr *vid_hdr = ubi_get_vid_hdr(vidb);
1307 struct ubi_volume *vol;
1308 uint32_t crc;
1309
1310 ubi_assert(rwsem_is_locked(&ubi->fm_eba_sem));
1311
1312 vol_id = be32_to_cpu(vid_hdr->vol_id);
1313 lnum = be32_to_cpu(vid_hdr->lnum);
1314
1315 dbg_wl("copy LEB %d:%d, PEB %d to PEB %d", vol_id, lnum, from, to);
1316
1317 if (vid_hdr->vol_type == UBI_VID_STATIC) {
1318 data_size = be32_to_cpu(vid_hdr->data_size);
1319 aldata_size = ALIGN(data_size, ubi->min_io_size);
1320 } else
1321 data_size = aldata_size =
1322 ubi->leb_size - be32_to_cpu(vid_hdr->data_pad);
1323
1324 idx = vol_id2idx(ubi, vol_id);
1325 spin_lock(&ubi->volumes_lock);
1326
1327
1328
1329
1330
1331
1332 vol = ubi->volumes[idx];
1333 spin_unlock(&ubi->volumes_lock);
1334 if (!vol) {
1335
1336 dbg_wl("volume %d is being removed, cancel", vol_id);
1337 return MOVE_CANCEL_RACE;
1338 }
1339
1340
1341
1342
1343
1344
1345
1346
1347
1348
1349
1350
1351
1352
1353
1354
1355 err = leb_write_trylock(ubi, vol_id, lnum);
1356 if (err) {
1357 dbg_wl("contention on LEB %d:%d, cancel", vol_id, lnum);
1358 return MOVE_RETRY;
1359 }
1360
1361
1362
1363
1364
1365
1366 if (vol->eba_tbl->entries[lnum].pnum != from) {
1367 dbg_wl("LEB %d:%d is no longer mapped to PEB %d, mapped to PEB %d, cancel",
1368 vol_id, lnum, from, vol->eba_tbl->entries[lnum].pnum);
1369 err = MOVE_CANCEL_RACE;
1370 goto out_unlock_leb;
1371 }
1372
1373
1374
1375
1376
1377
1378
1379 mutex_lock(&ubi->buf_mutex);
1380 dbg_wl("read %d bytes of data", aldata_size);
1381 err = ubi_io_read_data(ubi, ubi->peb_buf, from, 0, aldata_size);
1382 if (err && err != UBI_IO_BITFLIPS) {
1383 ubi_warn(ubi, "error %d while reading data from PEB %d",
1384 err, from);
1385 err = MOVE_SOURCE_RD_ERR;
1386 goto out_unlock_buf;
1387 }
1388
1389
1390
1391
1392
1393
1394
1395
1396
1397
1398
1399 if (vid_hdr->vol_type == UBI_VID_DYNAMIC)
1400 aldata_size = data_size =
1401 ubi_calc_data_len(ubi, ubi->peb_buf, data_size);
1402
1403 cond_resched();
1404 crc = crc32(UBI_CRC32_INIT, ubi->peb_buf, data_size);
1405 cond_resched();
1406
1407
1408
1409
1410
1411
1412
1413 if (data_size > 0) {
1414 vid_hdr->copy_flag = 1;
1415 vid_hdr->data_size = cpu_to_be32(data_size);
1416 vid_hdr->data_crc = cpu_to_be32(crc);
1417 }
1418 vid_hdr->sqnum = cpu_to_be64(ubi_next_sqnum(ubi));
1419
1420 err = ubi_io_write_vid_hdr(ubi, to, vidb);
1421 if (err) {
1422 if (err == -EIO)
1423 err = MOVE_TARGET_WR_ERR;
1424 goto out_unlock_buf;
1425 }
1426
1427 cond_resched();
1428
1429
1430 err = ubi_io_read_vid_hdr(ubi, to, vidb, 1);
1431 if (err) {
1432 if (err != UBI_IO_BITFLIPS) {
1433 ubi_warn(ubi, "error %d while reading VID header back from PEB %d",
1434 err, to);
1435 if (is_error_sane(err))
1436 err = MOVE_TARGET_RD_ERR;
1437 } else
1438 err = MOVE_TARGET_BITFLIPS;
1439 goto out_unlock_buf;
1440 }
1441
1442 if (data_size > 0) {
1443 err = ubi_io_write_data(ubi, ubi->peb_buf, to, 0, aldata_size);
1444 if (err) {
1445 if (err == -EIO)
1446 err = MOVE_TARGET_WR_ERR;
1447 goto out_unlock_buf;
1448 }
1449
1450 cond_resched();
1451 }
1452
1453 ubi_assert(vol->eba_tbl->entries[lnum].pnum == from);
1454 vol->eba_tbl->entries[lnum].pnum = to;
1455
1456 out_unlock_buf:
1457 mutex_unlock(&ubi->buf_mutex);
1458 out_unlock_leb:
1459 leb_write_unlock(ubi, vol_id, lnum);
1460 return err;
1461 }
1462
1463
1464
1465
1466
1467
1468
1469
1470
1471
1472
1473
1474
1475
1476
1477
1478
1479
1480
1481 static void print_rsvd_warning(struct ubi_device *ubi,
1482 struct ubi_attach_info *ai)
1483 {
1484
1485
1486
1487
1488 if (ai->max_sqnum > (1 << 18)) {
1489 int min = ubi->beb_rsvd_level / 10;
1490
1491 if (!min)
1492 min = 1;
1493 if (ubi->beb_rsvd_pebs > min)
1494 return;
1495 }
1496
1497 ubi_warn(ubi, "cannot reserve enough PEBs for bad PEB handling, reserved %d, need %d",
1498 ubi->beb_rsvd_pebs, ubi->beb_rsvd_level);
1499 if (ubi->corr_peb_count)
1500 ubi_warn(ubi, "%d PEBs are corrupted and not used",
1501 ubi->corr_peb_count);
1502 }
1503
1504
1505
1506
1507
1508
1509
1510
1511
1512
1513
1514 int self_check_eba(struct ubi_device *ubi, struct ubi_attach_info *ai_fastmap,
1515 struct ubi_attach_info *ai_scan)
1516 {
1517 int i, j, num_volumes, ret = 0;
1518 int **scan_eba, **fm_eba;
1519 struct ubi_ainf_volume *av;
1520 struct ubi_volume *vol;
1521 struct ubi_ainf_peb *aeb;
1522 struct rb_node *rb;
1523
1524 num_volumes = ubi->vtbl_slots + UBI_INT_VOL_COUNT;
1525
1526 scan_eba = kmalloc_array(num_volumes, sizeof(*scan_eba), GFP_KERNEL);
1527 if (!scan_eba)
1528 return -ENOMEM;
1529
1530 fm_eba = kmalloc_array(num_volumes, sizeof(*fm_eba), GFP_KERNEL);
1531 if (!fm_eba) {
1532 kfree(scan_eba);
1533 return -ENOMEM;
1534 }
1535
1536 for (i = 0; i < num_volumes; i++) {
1537 vol = ubi->volumes[i];
1538 if (!vol)
1539 continue;
1540
1541 scan_eba[i] = kmalloc_array(vol->reserved_pebs,
1542 sizeof(**scan_eba),
1543 GFP_KERNEL);
1544 if (!scan_eba[i]) {
1545 ret = -ENOMEM;
1546 goto out_free;
1547 }
1548
1549 fm_eba[i] = kmalloc_array(vol->reserved_pebs,
1550 sizeof(**fm_eba),
1551 GFP_KERNEL);
1552 if (!fm_eba[i]) {
1553 ret = -ENOMEM;
1554 goto out_free;
1555 }
1556
1557 for (j = 0; j < vol->reserved_pebs; j++)
1558 scan_eba[i][j] = fm_eba[i][j] = UBI_LEB_UNMAPPED;
1559
1560 av = ubi_find_av(ai_scan, idx2vol_id(ubi, i));
1561 if (!av)
1562 continue;
1563
1564 ubi_rb_for_each_entry(rb, aeb, &av->root, u.rb)
1565 scan_eba[i][aeb->lnum] = aeb->pnum;
1566
1567 av = ubi_find_av(ai_fastmap, idx2vol_id(ubi, i));
1568 if (!av)
1569 continue;
1570
1571 ubi_rb_for_each_entry(rb, aeb, &av->root, u.rb)
1572 fm_eba[i][aeb->lnum] = aeb->pnum;
1573
1574 for (j = 0; j < vol->reserved_pebs; j++) {
1575 if (scan_eba[i][j] != fm_eba[i][j]) {
1576 if (scan_eba[i][j] == UBI_LEB_UNMAPPED ||
1577 fm_eba[i][j] == UBI_LEB_UNMAPPED)
1578 continue;
1579
1580 ubi_err(ubi, "LEB:%i:%i is PEB:%i instead of %i!",
1581 vol->vol_id, j, fm_eba[i][j],
1582 scan_eba[i][j]);
1583 ubi_assert(0);
1584 }
1585 }
1586 }
1587
1588 out_free:
1589 for (i = 0; i < num_volumes; i++) {
1590 if (!ubi->volumes[i])
1591 continue;
1592
1593 kfree(scan_eba[i]);
1594 kfree(fm_eba[i]);
1595 }
1596
1597 kfree(scan_eba);
1598 kfree(fm_eba);
1599 return ret;
1600 }
1601
1602
1603
1604
1605
1606
1607
1608
1609
1610 int ubi_eba_init(struct ubi_device *ubi, struct ubi_attach_info *ai)
1611 {
1612 int i, err, num_volumes;
1613 struct ubi_ainf_volume *av;
1614 struct ubi_volume *vol;
1615 struct ubi_ainf_peb *aeb;
1616 struct rb_node *rb;
1617
1618 dbg_eba("initialize EBA sub-system");
1619
1620 spin_lock_init(&ubi->ltree_lock);
1621 mutex_init(&ubi->alc_mutex);
1622 ubi->ltree = RB_ROOT;
1623
1624 ubi->global_sqnum = ai->max_sqnum + 1;
1625 num_volumes = ubi->vtbl_slots + UBI_INT_VOL_COUNT;
1626
1627 for (i = 0; i < num_volumes; i++) {
1628 struct ubi_eba_table *tbl;
1629
1630 vol = ubi->volumes[i];
1631 if (!vol)
1632 continue;
1633
1634 cond_resched();
1635
1636 tbl = ubi_eba_create_table(vol, vol->reserved_pebs);
1637 if (IS_ERR(tbl)) {
1638 err = PTR_ERR(tbl);
1639 goto out_free;
1640 }
1641
1642 ubi_eba_replace_table(vol, tbl);
1643
1644 av = ubi_find_av(ai, idx2vol_id(ubi, i));
1645 if (!av)
1646 continue;
1647
1648 ubi_rb_for_each_entry(rb, aeb, &av->root, u.rb) {
1649 if (aeb->lnum >= vol->reserved_pebs) {
1650
1651
1652
1653
1654 ubi_move_aeb_to_list(av, aeb, &ai->erase);
1655 } else {
1656 struct ubi_eba_entry *entry;
1657
1658 entry = &vol->eba_tbl->entries[aeb->lnum];
1659 entry->pnum = aeb->pnum;
1660 }
1661 }
1662 }
1663
1664 if (ubi->avail_pebs < EBA_RESERVED_PEBS) {
1665 ubi_err(ubi, "no enough physical eraseblocks (%d, need %d)",
1666 ubi->avail_pebs, EBA_RESERVED_PEBS);
1667 if (ubi->corr_peb_count)
1668 ubi_err(ubi, "%d PEBs are corrupted and not used",
1669 ubi->corr_peb_count);
1670 err = -ENOSPC;
1671 goto out_free;
1672 }
1673 ubi->avail_pebs -= EBA_RESERVED_PEBS;
1674 ubi->rsvd_pebs += EBA_RESERVED_PEBS;
1675
1676 if (ubi->bad_allowed) {
1677 ubi_calculate_reserved(ubi);
1678
1679 if (ubi->avail_pebs < ubi->beb_rsvd_level) {
1680
1681 ubi->beb_rsvd_pebs = ubi->avail_pebs;
1682 print_rsvd_warning(ubi, ai);
1683 } else
1684 ubi->beb_rsvd_pebs = ubi->beb_rsvd_level;
1685
1686 ubi->avail_pebs -= ubi->beb_rsvd_pebs;
1687 ubi->rsvd_pebs += ubi->beb_rsvd_pebs;
1688 }
1689
1690 dbg_eba("EBA sub-system is initialized");
1691 return 0;
1692
1693 out_free:
1694 for (i = 0; i < num_volumes; i++) {
1695 if (!ubi->volumes[i])
1696 continue;
1697 ubi_eba_replace_table(ubi->volumes[i], NULL);
1698 }
1699 return err;
1700 }