1
2
3
4
5
6
7#include "zdata.h"
8#include "compress.h"
9#include <linux/prefetch.h>
10
11#include <trace/events/erofs.h>
12
13
14
15
16
17#define PAGE_UNALLOCATED ((void *)0x5F0E4B1D)
18
19
20enum z_erofs_cache_alloctype {
21 DONTALLOC,
22 DELAYEDALLOC,
23};
24
25
26
27
28
29typedef tagptr1_t compressed_page_t;
30
31#define tag_compressed_page_justfound(page) \
32 tagptr_fold(compressed_page_t, page, 1)
33
34static struct workqueue_struct *z_erofs_workqueue __read_mostly;
35static struct kmem_cache *pcluster_cachep __read_mostly;
36
37void z_erofs_exit_zip_subsystem(void)
38{
39 destroy_workqueue(z_erofs_workqueue);
40 kmem_cache_destroy(pcluster_cachep);
41}
42
43static inline int z_erofs_init_workqueue(void)
44{
45 const unsigned int onlinecpus = num_possible_cpus();
46 const unsigned int flags = WQ_UNBOUND | WQ_HIGHPRI | WQ_CPU_INTENSIVE;
47
48
49
50
51
52 z_erofs_workqueue = alloc_workqueue("erofs_unzipd", flags,
53 onlinecpus + onlinecpus / 4);
54 return z_erofs_workqueue ? 0 : -ENOMEM;
55}
56
57static void z_erofs_pcluster_init_once(void *ptr)
58{
59 struct z_erofs_pcluster *pcl = ptr;
60 struct z_erofs_collection *cl = z_erofs_primarycollection(pcl);
61 unsigned int i;
62
63 mutex_init(&cl->lock);
64 cl->nr_pages = 0;
65 cl->vcnt = 0;
66 for (i = 0; i < Z_EROFS_CLUSTER_MAX_PAGES; ++i)
67 pcl->compressed_pages[i] = NULL;
68}
69
70static void z_erofs_pcluster_init_always(struct z_erofs_pcluster *pcl)
71{
72 struct z_erofs_collection *cl = z_erofs_primarycollection(pcl);
73
74 atomic_set(&pcl->obj.refcount, 1);
75
76 DBG_BUGON(cl->nr_pages);
77 DBG_BUGON(cl->vcnt);
78}
79
80int __init z_erofs_init_zip_subsystem(void)
81{
82 pcluster_cachep = kmem_cache_create("erofs_compress",
83 Z_EROFS_WORKGROUP_SIZE, 0,
84 SLAB_RECLAIM_ACCOUNT,
85 z_erofs_pcluster_init_once);
86 if (pcluster_cachep) {
87 if (!z_erofs_init_workqueue())
88 return 0;
89
90 kmem_cache_destroy(pcluster_cachep);
91 }
92 return -ENOMEM;
93}
94
95enum z_erofs_collectmode {
96 COLLECT_SECONDARY,
97 COLLECT_PRIMARY,
98
99
100
101
102
103
104
105
106
107
108
109
110
111 COLLECT_PRIMARY_HOOKED,
112 COLLECT_PRIMARY_FOLLOWED_NOINPLACE,
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128 COLLECT_PRIMARY_FOLLOWED,
129};
130
131struct z_erofs_collector {
132 struct z_erofs_pagevec_ctor vector;
133
134 struct z_erofs_pcluster *pcl, *tailpcl;
135 struct z_erofs_collection *cl;
136 struct page **compressedpages;
137 z_erofs_next_pcluster_t owned_head;
138
139 enum z_erofs_collectmode mode;
140};
141
142struct z_erofs_decompress_frontend {
143 struct inode *const inode;
144
145 struct z_erofs_collector clt;
146 struct erofs_map_blocks map;
147
148
149 bool backmost;
150 erofs_off_t headoffset;
151};
152
153#define COLLECTOR_INIT() { \
154 .owned_head = Z_EROFS_PCLUSTER_TAIL, \
155 .mode = COLLECT_PRIMARY_FOLLOWED }
156
157#define DECOMPRESS_FRONTEND_INIT(__i) { \
158 .inode = __i, .clt = COLLECTOR_INIT(), \
159 .backmost = true, }
160
161static struct page *z_pagemap_global[Z_EROFS_VMAP_GLOBAL_PAGES];
162static DEFINE_MUTEX(z_pagemap_global_lock);
163
164static void preload_compressed_pages(struct z_erofs_collector *clt,
165 struct address_space *mc,
166 enum z_erofs_cache_alloctype type,
167 struct list_head *pagepool)
168{
169 const struct z_erofs_pcluster *pcl = clt->pcl;
170 const unsigned int clusterpages = BIT(pcl->clusterbits);
171 struct page **pages = clt->compressedpages;
172 pgoff_t index = pcl->obj.index + (pages - pcl->compressed_pages);
173 bool standalone = true;
174
175 if (clt->mode < COLLECT_PRIMARY_FOLLOWED)
176 return;
177
178 for (; pages < pcl->compressed_pages + clusterpages; ++pages) {
179 struct page *page;
180 compressed_page_t t;
181
182
183 if (READ_ONCE(*pages))
184 continue;
185
186 page = find_get_page(mc, index);
187
188 if (page) {
189 t = tag_compressed_page_justfound(page);
190 } else if (type == DELAYEDALLOC) {
191 t = tagptr_init(compressed_page_t, PAGE_UNALLOCATED);
192 } else {
193 if (standalone)
194 clt->compressedpages = pages;
195 standalone = false;
196 continue;
197 }
198
199 if (!cmpxchg_relaxed(pages, NULL, tagptr_cast_ptr(t)))
200 continue;
201
202 if (page)
203 put_page(page);
204 }
205
206 if (standalone)
207 clt->mode = COLLECT_PRIMARY_FOLLOWED_NOINPLACE;
208}
209
210
211int erofs_try_to_free_all_cached_pages(struct erofs_sb_info *sbi,
212 struct erofs_workgroup *grp)
213{
214 struct z_erofs_pcluster *const pcl =
215 container_of(grp, struct z_erofs_pcluster, obj);
216 struct address_space *const mapping = MNGD_MAPPING(sbi);
217 const unsigned int clusterpages = BIT(pcl->clusterbits);
218 int i;
219
220
221
222
223
224 for (i = 0; i < clusterpages; ++i) {
225 struct page *page = pcl->compressed_pages[i];
226
227 if (!page)
228 continue;
229
230
231 if (!trylock_page(page))
232 return -EBUSY;
233
234 if (page->mapping != mapping)
235 continue;
236
237
238 WRITE_ONCE(pcl->compressed_pages[i], NULL);
239 set_page_private(page, 0);
240 ClearPagePrivate(page);
241
242 unlock_page(page);
243 put_page(page);
244 }
245 return 0;
246}
247
248int erofs_try_to_free_cached_page(struct address_space *mapping,
249 struct page *page)
250{
251 struct z_erofs_pcluster *const pcl = (void *)page_private(page);
252 const unsigned int clusterpages = BIT(pcl->clusterbits);
253 int ret = 0;
254
255 if (erofs_workgroup_try_to_freeze(&pcl->obj, 1)) {
256 unsigned int i;
257
258 for (i = 0; i < clusterpages; ++i) {
259 if (pcl->compressed_pages[i] == page) {
260 WRITE_ONCE(pcl->compressed_pages[i], NULL);
261 ret = 1;
262 break;
263 }
264 }
265 erofs_workgroup_unfreeze(&pcl->obj, 1);
266
267 if (ret) {
268 ClearPagePrivate(page);
269 put_page(page);
270 }
271 }
272 return ret;
273}
274
275
276static inline bool z_erofs_try_inplace_io(struct z_erofs_collector *clt,
277 struct page *page)
278{
279 struct z_erofs_pcluster *const pcl = clt->pcl;
280 const unsigned int clusterpages = BIT(pcl->clusterbits);
281
282 while (clt->compressedpages < pcl->compressed_pages + clusterpages) {
283 if (!cmpxchg(clt->compressedpages++, NULL, page))
284 return true;
285 }
286 return false;
287}
288
289
290static int z_erofs_attach_page(struct z_erofs_collector *clt,
291 struct page *page,
292 enum z_erofs_page_type type)
293{
294 int ret;
295 bool occupied;
296
297
298 if (clt->mode >= COLLECT_PRIMARY &&
299 type == Z_EROFS_PAGE_TYPE_EXCLUSIVE &&
300 z_erofs_try_inplace_io(clt, page))
301 return 0;
302
303 ret = z_erofs_pagevec_enqueue(&clt->vector,
304 page, type, &occupied);
305 clt->cl->vcnt += (unsigned int)ret;
306
307 return ret ? 0 : -EAGAIN;
308}
309
310static enum z_erofs_collectmode
311try_to_claim_pcluster(struct z_erofs_pcluster *pcl,
312 z_erofs_next_pcluster_t *owned_head)
313{
314
315retry:
316 if (pcl->next == Z_EROFS_PCLUSTER_NIL) {
317
318 if (cmpxchg(&pcl->next, Z_EROFS_PCLUSTER_NIL,
319 *owned_head) != Z_EROFS_PCLUSTER_NIL)
320 goto retry;
321
322 *owned_head = &pcl->next;
323
324 return COLLECT_PRIMARY_FOLLOWED;
325 } else if (pcl->next == Z_EROFS_PCLUSTER_TAIL) {
326
327
328
329
330
331 if (cmpxchg(&pcl->next, Z_EROFS_PCLUSTER_TAIL,
332 *owned_head) != Z_EROFS_PCLUSTER_TAIL)
333 goto retry;
334 *owned_head = Z_EROFS_PCLUSTER_TAIL;
335 return COLLECT_PRIMARY_HOOKED;
336 }
337 return COLLECT_PRIMARY;
338}
339
340static int z_erofs_lookup_collection(struct z_erofs_collector *clt,
341 struct inode *inode,
342 struct erofs_map_blocks *map)
343{
344 struct erofs_workgroup *grp;
345 struct z_erofs_pcluster *pcl;
346 struct z_erofs_collection *cl;
347 unsigned int length;
348
349 grp = erofs_find_workgroup(inode->i_sb, map->m_pa >> PAGE_SHIFT);
350 if (!grp)
351 return -ENOENT;
352
353 pcl = container_of(grp, struct z_erofs_pcluster, obj);
354 if (clt->owned_head == &pcl->next || pcl == clt->tailpcl) {
355 DBG_BUGON(1);
356 erofs_workgroup_put(grp);
357 return -EFSCORRUPTED;
358 }
359
360 cl = z_erofs_primarycollection(pcl);
361 if (cl->pageofs != (map->m_la & ~PAGE_MASK)) {
362 DBG_BUGON(1);
363 erofs_workgroup_put(grp);
364 return -EFSCORRUPTED;
365 }
366
367 length = READ_ONCE(pcl->length);
368 if (length & Z_EROFS_PCLUSTER_FULL_LENGTH) {
369 if ((map->m_llen << Z_EROFS_PCLUSTER_LENGTH_BIT) > length) {
370 DBG_BUGON(1);
371 erofs_workgroup_put(grp);
372 return -EFSCORRUPTED;
373 }
374 } else {
375 unsigned int llen = map->m_llen << Z_EROFS_PCLUSTER_LENGTH_BIT;
376
377 if (map->m_flags & EROFS_MAP_FULL_MAPPED)
378 llen |= Z_EROFS_PCLUSTER_FULL_LENGTH;
379
380 while (llen > length &&
381 length != cmpxchg_relaxed(&pcl->length, length, llen)) {
382 cpu_relax();
383 length = READ_ONCE(pcl->length);
384 }
385 }
386 mutex_lock(&cl->lock);
387
388 if (clt->owned_head == Z_EROFS_PCLUSTER_TAIL)
389 clt->tailpcl = pcl;
390 clt->mode = try_to_claim_pcluster(pcl, &clt->owned_head);
391
392 if (clt->owned_head == Z_EROFS_PCLUSTER_TAIL)
393 clt->tailpcl = NULL;
394 clt->pcl = pcl;
395 clt->cl = cl;
396 return 0;
397}
398
399static int z_erofs_register_collection(struct z_erofs_collector *clt,
400 struct inode *inode,
401 struct erofs_map_blocks *map)
402{
403 struct z_erofs_pcluster *pcl;
404 struct z_erofs_collection *cl;
405 int err;
406
407
408 pcl = kmem_cache_alloc(pcluster_cachep, GFP_NOFS);
409 if (!pcl)
410 return -ENOMEM;
411
412 z_erofs_pcluster_init_always(pcl);
413 pcl->obj.index = map->m_pa >> PAGE_SHIFT;
414
415 pcl->length = (map->m_llen << Z_EROFS_PCLUSTER_LENGTH_BIT) |
416 (map->m_flags & EROFS_MAP_FULL_MAPPED ?
417 Z_EROFS_PCLUSTER_FULL_LENGTH : 0);
418
419 if (map->m_flags & EROFS_MAP_ZIPPED)
420 pcl->algorithmformat = Z_EROFS_COMPRESSION_LZ4;
421 else
422 pcl->algorithmformat = Z_EROFS_COMPRESSION_SHIFTED;
423
424 pcl->clusterbits = EROFS_I(inode)->z_physical_clusterbits[0];
425 pcl->clusterbits -= PAGE_SHIFT;
426
427
428 pcl->next = clt->owned_head;
429 clt->mode = COLLECT_PRIMARY_FOLLOWED;
430
431 cl = z_erofs_primarycollection(pcl);
432 cl->pageofs = map->m_la & ~PAGE_MASK;
433
434
435
436
437
438 mutex_trylock(&cl->lock);
439
440 err = erofs_register_workgroup(inode->i_sb, &pcl->obj);
441 if (err) {
442 mutex_unlock(&cl->lock);
443 kmem_cache_free(pcluster_cachep, pcl);
444 return -EAGAIN;
445 }
446
447 if (clt->owned_head == Z_EROFS_PCLUSTER_TAIL)
448 clt->tailpcl = pcl;
449 clt->owned_head = &pcl->next;
450 clt->pcl = pcl;
451 clt->cl = cl;
452 return 0;
453}
454
455static int z_erofs_collector_begin(struct z_erofs_collector *clt,
456 struct inode *inode,
457 struct erofs_map_blocks *map)
458{
459 int ret;
460
461 DBG_BUGON(clt->cl);
462
463
464 DBG_BUGON(clt->owned_head == Z_EROFS_PCLUSTER_NIL);
465 DBG_BUGON(clt->owned_head == Z_EROFS_PCLUSTER_TAIL_CLOSED);
466
467 if (!PAGE_ALIGNED(map->m_pa)) {
468 DBG_BUGON(1);
469 return -EINVAL;
470 }
471
472repeat:
473 ret = z_erofs_lookup_collection(clt, inode, map);
474 if (ret == -ENOENT) {
475 ret = z_erofs_register_collection(clt, inode, map);
476
477
478 if (ret == -EAGAIN) {
479 cond_resched();
480 goto repeat;
481 }
482 }
483
484 if (ret)
485 return ret;
486
487 z_erofs_pagevec_ctor_init(&clt->vector, Z_EROFS_NR_INLINE_PAGEVECS,
488 clt->cl->pagevec, clt->cl->vcnt);
489
490 clt->compressedpages = clt->pcl->compressed_pages;
491 if (clt->mode <= COLLECT_PRIMARY)
492 clt->compressedpages += Z_EROFS_CLUSTER_MAX_PAGES;
493 return 0;
494}
495
496
497
498
499
500static void z_erofs_rcu_callback(struct rcu_head *head)
501{
502 struct z_erofs_collection *const cl =
503 container_of(head, struct z_erofs_collection, rcu);
504
505 kmem_cache_free(pcluster_cachep,
506 container_of(cl, struct z_erofs_pcluster,
507 primary_collection));
508}
509
510void erofs_workgroup_free_rcu(struct erofs_workgroup *grp)
511{
512 struct z_erofs_pcluster *const pcl =
513 container_of(grp, struct z_erofs_pcluster, obj);
514 struct z_erofs_collection *const cl = z_erofs_primarycollection(pcl);
515
516 call_rcu(&cl->rcu, z_erofs_rcu_callback);
517}
518
519static void z_erofs_collection_put(struct z_erofs_collection *cl)
520{
521 struct z_erofs_pcluster *const pcl =
522 container_of(cl, struct z_erofs_pcluster, primary_collection);
523
524 erofs_workgroup_put(&pcl->obj);
525}
526
527static bool z_erofs_collector_end(struct z_erofs_collector *clt)
528{
529 struct z_erofs_collection *cl = clt->cl;
530
531 if (!cl)
532 return false;
533
534 z_erofs_pagevec_ctor_exit(&clt->vector, false);
535 mutex_unlock(&cl->lock);
536
537
538
539
540
541 if (clt->mode < COLLECT_PRIMARY_FOLLOWED_NOINPLACE)
542 z_erofs_collection_put(cl);
543
544 clt->cl = NULL;
545 return true;
546}
547
548static bool should_alloc_managed_pages(struct z_erofs_decompress_frontend *fe,
549 unsigned int cachestrategy,
550 erofs_off_t la)
551{
552 if (cachestrategy <= EROFS_ZIP_CACHE_DISABLED)
553 return false;
554
555 if (fe->backmost)
556 return true;
557
558 return cachestrategy >= EROFS_ZIP_CACHE_READAROUND &&
559 la < fe->headoffset;
560}
561
562static int z_erofs_do_read_page(struct z_erofs_decompress_frontend *fe,
563 struct page *page,
564 struct list_head *pagepool)
565{
566 struct inode *const inode = fe->inode;
567 struct erofs_sb_info *const sbi = EROFS_I_SB(inode);
568 struct erofs_map_blocks *const map = &fe->map;
569 struct z_erofs_collector *const clt = &fe->clt;
570 const loff_t offset = page_offset(page);
571 bool tight = true;
572
573 enum z_erofs_cache_alloctype cache_strategy;
574 enum z_erofs_page_type page_type;
575 unsigned int cur, end, spiltted, index;
576 int err = 0;
577
578
579 z_erofs_onlinepage_init(page);
580
581 spiltted = 0;
582 end = PAGE_SIZE;
583repeat:
584 cur = end - 1;
585
586
587 if (offset + cur >= map->m_la &&
588 offset + cur < map->m_la + map->m_llen) {
589
590 if (!clt->cl)
591 goto restart_now;
592 goto hitted;
593 }
594
595
596 erofs_dbg("%s: [out-of-range] pos %llu", __func__, offset + cur);
597
598 if (z_erofs_collector_end(clt))
599 fe->backmost = false;
600
601 map->m_la = offset + cur;
602 map->m_llen = 0;
603 err = z_erofs_map_blocks_iter(inode, map, 0);
604 if (err)
605 goto err_out;
606
607restart_now:
608 if (!(map->m_flags & EROFS_MAP_MAPPED))
609 goto hitted;
610
611 err = z_erofs_collector_begin(clt, inode, map);
612 if (err)
613 goto err_out;
614
615
616 if (should_alloc_managed_pages(fe, sbi->cache_strategy, map->m_la))
617 cache_strategy = DELAYEDALLOC;
618 else
619 cache_strategy = DONTALLOC;
620
621 preload_compressed_pages(clt, MNGD_MAPPING(sbi),
622 cache_strategy, pagepool);
623
624hitted:
625
626
627
628
629
630
631 tight &= (clt->mode >= COLLECT_PRIMARY_HOOKED &&
632 clt->mode != COLLECT_PRIMARY_FOLLOWED_NOINPLACE);
633
634 cur = end - min_t(unsigned int, offset + end - map->m_la, end);
635 if (!(map->m_flags & EROFS_MAP_MAPPED)) {
636 zero_user_segment(page, cur, end);
637 goto next_part;
638 }
639
640
641 page_type = cur ? Z_EROFS_VLE_PAGE_TYPE_HEAD :
642 (!spiltted ? Z_EROFS_PAGE_TYPE_EXCLUSIVE :
643 (tight ? Z_EROFS_PAGE_TYPE_EXCLUSIVE :
644 Z_EROFS_VLE_PAGE_TYPE_TAIL_SHARED));
645
646 if (cur)
647 tight &= (clt->mode >= COLLECT_PRIMARY_FOLLOWED);
648
649retry:
650 err = z_erofs_attach_page(clt, page, page_type);
651
652 if (err == -EAGAIN) {
653 struct page *const newpage =
654 erofs_allocpage(pagepool, GFP_NOFS | __GFP_NOFAIL);
655
656 newpage->mapping = Z_EROFS_MAPPING_STAGING;
657 err = z_erofs_attach_page(clt, newpage,
658 Z_EROFS_PAGE_TYPE_EXCLUSIVE);
659 if (!err)
660 goto retry;
661 }
662
663 if (err)
664 goto err_out;
665
666 index = page->index - (map->m_la >> PAGE_SHIFT);
667
668 z_erofs_onlinepage_fixup(page, index, true);
669
670
671 ++spiltted;
672
673 clt->cl->nr_pages = max_t(pgoff_t, clt->cl->nr_pages, index + 1);
674next_part:
675
676 map->m_llen = offset + cur - map->m_la;
677
678 end = cur;
679 if (end > 0)
680 goto repeat;
681
682out:
683 z_erofs_onlinepage_endio(page);
684
685 erofs_dbg("%s, finish page: %pK spiltted: %u map->m_llen %llu",
686 __func__, page, spiltted, map->m_llen);
687 return err;
688
689
690err_out:
691 SetPageError(page);
692 goto out;
693}
694
695static void z_erofs_decompress_kickoff(struct z_erofs_decompressqueue *io,
696 bool sync, int bios)
697{
698
699 if (sync) {
700 unsigned long flags;
701
702 spin_lock_irqsave(&io->u.wait.lock, flags);
703 if (!atomic_add_return(bios, &io->pending_bios))
704 wake_up_locked(&io->u.wait);
705 spin_unlock_irqrestore(&io->u.wait.lock, flags);
706 return;
707 }
708
709 if (!atomic_add_return(bios, &io->pending_bios))
710 queue_work(z_erofs_workqueue, &io->u.work);
711}
712
713static void z_erofs_decompressqueue_endio(struct bio *bio)
714{
715 tagptr1_t t = tagptr_init(tagptr1_t, bio->bi_private);
716 struct z_erofs_decompressqueue *q = tagptr_unfold_ptr(t);
717 blk_status_t err = bio->bi_status;
718 struct bio_vec *bvec;
719 struct bvec_iter_all iter_all;
720
721 bio_for_each_segment_all(bvec, bio, iter_all) {
722 struct page *page = bvec->bv_page;
723
724 DBG_BUGON(PageUptodate(page));
725 DBG_BUGON(!page->mapping);
726
727 if (err)
728 SetPageError(page);
729
730 if (erofs_page_is_managed(EROFS_SB(q->sb), page)) {
731 if (!err)
732 SetPageUptodate(page);
733 unlock_page(page);
734 }
735 }
736 z_erofs_decompress_kickoff(q, tagptr_unfold_tags(t), -1);
737 bio_put(bio);
738}
739
740static int z_erofs_decompress_pcluster(struct super_block *sb,
741 struct z_erofs_pcluster *pcl,
742 struct list_head *pagepool)
743{
744 struct erofs_sb_info *const sbi = EROFS_SB(sb);
745 const unsigned int clusterpages = BIT(pcl->clusterbits);
746 struct z_erofs_pagevec_ctor ctor;
747 unsigned int i, outputsize, llen, nr_pages;
748 struct page *pages_onstack[Z_EROFS_VMAP_ONSTACK_PAGES];
749 struct page **pages, **compressed_pages, *page;
750
751 enum z_erofs_page_type page_type;
752 bool overlapped, partial;
753 struct z_erofs_collection *cl;
754 int err;
755
756 might_sleep();
757 cl = z_erofs_primarycollection(pcl);
758 DBG_BUGON(!READ_ONCE(cl->nr_pages));
759
760 mutex_lock(&cl->lock);
761 nr_pages = cl->nr_pages;
762
763 if (nr_pages <= Z_EROFS_VMAP_ONSTACK_PAGES) {
764 pages = pages_onstack;
765 } else if (nr_pages <= Z_EROFS_VMAP_GLOBAL_PAGES &&
766 mutex_trylock(&z_pagemap_global_lock)) {
767 pages = z_pagemap_global;
768 } else {
769 gfp_t gfp_flags = GFP_KERNEL;
770
771 if (nr_pages > Z_EROFS_VMAP_GLOBAL_PAGES)
772 gfp_flags |= __GFP_NOFAIL;
773
774 pages = kvmalloc_array(nr_pages, sizeof(struct page *),
775 gfp_flags);
776
777
778 if (!pages) {
779 mutex_lock(&z_pagemap_global_lock);
780 pages = z_pagemap_global;
781 }
782 }
783
784 for (i = 0; i < nr_pages; ++i)
785 pages[i] = NULL;
786
787 err = 0;
788 z_erofs_pagevec_ctor_init(&ctor, Z_EROFS_NR_INLINE_PAGEVECS,
789 cl->pagevec, 0);
790
791 for (i = 0; i < cl->vcnt; ++i) {
792 unsigned int pagenr;
793
794 page = z_erofs_pagevec_dequeue(&ctor, &page_type);
795
796
797 DBG_BUGON(!page);
798 DBG_BUGON(!page->mapping);
799
800 if (z_erofs_put_stagingpage(pagepool, page))
801 continue;
802
803 if (page_type == Z_EROFS_VLE_PAGE_TYPE_HEAD)
804 pagenr = 0;
805 else
806 pagenr = z_erofs_onlinepage_index(page);
807
808 DBG_BUGON(pagenr >= nr_pages);
809
810
811
812
813
814 if (pages[pagenr]) {
815 DBG_BUGON(1);
816 SetPageError(pages[pagenr]);
817 z_erofs_onlinepage_endio(pages[pagenr]);
818 err = -EFSCORRUPTED;
819 }
820 pages[pagenr] = page;
821 }
822 z_erofs_pagevec_ctor_exit(&ctor, true);
823
824 overlapped = false;
825 compressed_pages = pcl->compressed_pages;
826
827 for (i = 0; i < clusterpages; ++i) {
828 unsigned int pagenr;
829
830 page = compressed_pages[i];
831
832
833 DBG_BUGON(!page);
834 DBG_BUGON(!page->mapping);
835
836 if (!z_erofs_page_is_staging(page)) {
837 if (erofs_page_is_managed(sbi, page)) {
838 if (!PageUptodate(page))
839 err = -EIO;
840 continue;
841 }
842
843
844
845
846
847 pagenr = z_erofs_onlinepage_index(page);
848
849 DBG_BUGON(pagenr >= nr_pages);
850 if (pages[pagenr]) {
851 DBG_BUGON(1);
852 SetPageError(pages[pagenr]);
853 z_erofs_onlinepage_endio(pages[pagenr]);
854 err = -EFSCORRUPTED;
855 }
856 pages[pagenr] = page;
857
858 overlapped = true;
859 }
860
861
862 if (PageError(page)) {
863 DBG_BUGON(PageUptodate(page));
864 err = -EIO;
865 }
866 }
867
868 if (err)
869 goto out;
870
871 llen = pcl->length >> Z_EROFS_PCLUSTER_LENGTH_BIT;
872 if (nr_pages << PAGE_SHIFT >= cl->pageofs + llen) {
873 outputsize = llen;
874 partial = !(pcl->length & Z_EROFS_PCLUSTER_FULL_LENGTH);
875 } else {
876 outputsize = (nr_pages << PAGE_SHIFT) - cl->pageofs;
877 partial = true;
878 }
879
880 err = z_erofs_decompress(&(struct z_erofs_decompress_req) {
881 .sb = sb,
882 .in = compressed_pages,
883 .out = pages,
884 .pageofs_out = cl->pageofs,
885 .inputsize = PAGE_SIZE,
886 .outputsize = outputsize,
887 .alg = pcl->algorithmformat,
888 .inplace_io = overlapped,
889 .partial_decoding = partial
890 }, pagepool);
891
892out:
893
894 for (i = 0; i < clusterpages; ++i) {
895 page = compressed_pages[i];
896
897 if (erofs_page_is_managed(sbi, page))
898 continue;
899
900
901 (void)z_erofs_put_stagingpage(pagepool, page);
902
903 WRITE_ONCE(compressed_pages[i], NULL);
904 }
905
906 for (i = 0; i < nr_pages; ++i) {
907 page = pages[i];
908 if (!page)
909 continue;
910
911 DBG_BUGON(!page->mapping);
912
913
914 if (z_erofs_put_stagingpage(pagepool, page))
915 continue;
916
917 if (err < 0)
918 SetPageError(page);
919
920 z_erofs_onlinepage_endio(page);
921 }
922
923 if (pages == z_pagemap_global)
924 mutex_unlock(&z_pagemap_global_lock);
925 else if (pages != pages_onstack)
926 kvfree(pages);
927
928 cl->nr_pages = 0;
929 cl->vcnt = 0;
930
931
932 WRITE_ONCE(pcl->next, Z_EROFS_PCLUSTER_NIL);
933
934
935 mutex_unlock(&cl->lock);
936
937 z_erofs_collection_put(cl);
938 return err;
939}
940
941static void z_erofs_decompress_queue(const struct z_erofs_decompressqueue *io,
942 struct list_head *pagepool)
943{
944 z_erofs_next_pcluster_t owned = io->head;
945
946 while (owned != Z_EROFS_PCLUSTER_TAIL_CLOSED) {
947 struct z_erofs_pcluster *pcl;
948
949
950 DBG_BUGON(owned == Z_EROFS_PCLUSTER_TAIL);
951
952
953 DBG_BUGON(owned == Z_EROFS_PCLUSTER_NIL);
954
955 pcl = container_of(owned, struct z_erofs_pcluster, next);
956 owned = READ_ONCE(pcl->next);
957
958 z_erofs_decompress_pcluster(io->sb, pcl, pagepool);
959 }
960}
961
962static void z_erofs_decompressqueue_work(struct work_struct *work)
963{
964 struct z_erofs_decompressqueue *bgq =
965 container_of(work, struct z_erofs_decompressqueue, u.work);
966 LIST_HEAD(pagepool);
967
968 DBG_BUGON(bgq->head == Z_EROFS_PCLUSTER_TAIL_CLOSED);
969 z_erofs_decompress_queue(bgq, &pagepool);
970
971 put_pages_list(&pagepool);
972 kvfree(bgq);
973}
974
975static struct page *pickup_page_for_submission(struct z_erofs_pcluster *pcl,
976 unsigned int nr,
977 struct list_head *pagepool,
978 struct address_space *mc,
979 gfp_t gfp)
980{
981 const pgoff_t index = pcl->obj.index;
982 bool tocache = false;
983
984 struct address_space *mapping;
985 struct page *oldpage, *page;
986
987 compressed_page_t t;
988 int justfound;
989
990repeat:
991 page = READ_ONCE(pcl->compressed_pages[nr]);
992 oldpage = page;
993
994 if (!page)
995 goto out_allocpage;
996
997
998
999
1000
1001 if (page == PAGE_UNALLOCATED) {
1002 tocache = true;
1003 goto out_allocpage;
1004 }
1005
1006
1007 t = tagptr_init(compressed_page_t, page);
1008 justfound = tagptr_unfold_tags(t);
1009 page = tagptr_unfold_ptr(t);
1010
1011 mapping = READ_ONCE(page->mapping);
1012
1013
1014
1015
1016
1017 if (mapping && mapping != mc)
1018
1019 goto out;
1020
1021 lock_page(page);
1022
1023
1024 DBG_BUGON(justfound && PagePrivate(page));
1025
1026
1027 if (page->mapping == mc) {
1028 WRITE_ONCE(pcl->compressed_pages[nr], page);
1029
1030 ClearPageError(page);
1031 if (!PagePrivate(page)) {
1032
1033
1034
1035
1036
1037 DBG_BUGON(!justfound);
1038
1039 justfound = 0;
1040 set_page_private(page, (unsigned long)pcl);
1041 SetPagePrivate(page);
1042 }
1043
1044
1045 if (PageUptodate(page)) {
1046 unlock_page(page);
1047 page = NULL;
1048 }
1049 goto out;
1050 }
1051
1052
1053
1054
1055
1056 DBG_BUGON(page->mapping);
1057 DBG_BUGON(!justfound);
1058
1059 tocache = true;
1060 unlock_page(page);
1061 put_page(page);
1062out_allocpage:
1063 page = erofs_allocpage(pagepool, gfp | __GFP_NOFAIL);
1064 if (!tocache || add_to_page_cache_lru(page, mc, index + nr, gfp)) {
1065
1066 page->mapping = Z_EROFS_MAPPING_STAGING;
1067 tocache = false;
1068 }
1069
1070 if (oldpage != cmpxchg(&pcl->compressed_pages[nr], oldpage, page)) {
1071 if (tocache) {
1072
1073 unlock_page(page);
1074 put_page(page);
1075 } else {
1076 list_add(&page->lru, pagepool);
1077 }
1078 cond_resched();
1079 goto repeat;
1080 }
1081 set_page_private(page, (unsigned long)pcl);
1082 SetPagePrivate(page);
1083out:
1084 return page;
1085}
1086
1087static struct z_erofs_decompressqueue *
1088jobqueue_init(struct super_block *sb,
1089 struct z_erofs_decompressqueue *fgq, bool *fg)
1090{
1091 struct z_erofs_decompressqueue *q;
1092
1093 if (fg && !*fg) {
1094 q = kvzalloc(sizeof(*q), GFP_KERNEL | __GFP_NOWARN);
1095 if (!q) {
1096 *fg = true;
1097 goto fg_out;
1098 }
1099 INIT_WORK(&q->u.work, z_erofs_decompressqueue_work);
1100 } else {
1101fg_out:
1102 q = fgq;
1103 init_waitqueue_head(&fgq->u.wait);
1104 atomic_set(&fgq->pending_bios, 0);
1105 }
1106 q->sb = sb;
1107 q->head = Z_EROFS_PCLUSTER_TAIL_CLOSED;
1108 return q;
1109}
1110
1111
1112enum {
1113 JQ_BYPASS,
1114 JQ_SUBMIT,
1115 NR_JOBQUEUES,
1116};
1117
1118static void *jobqueueset_init(struct super_block *sb,
1119 struct z_erofs_decompressqueue *q[],
1120 struct z_erofs_decompressqueue *fgq, bool *fg)
1121{
1122
1123
1124
1125
1126 q[JQ_BYPASS] = jobqueue_init(sb, fgq + JQ_BYPASS, NULL);
1127 q[JQ_SUBMIT] = jobqueue_init(sb, fgq + JQ_SUBMIT, fg);
1128
1129 return tagptr_cast_ptr(tagptr_fold(tagptr1_t, q[JQ_SUBMIT], *fg));
1130}
1131
1132static void move_to_bypass_jobqueue(struct z_erofs_pcluster *pcl,
1133 z_erofs_next_pcluster_t qtail[],
1134 z_erofs_next_pcluster_t owned_head)
1135{
1136 z_erofs_next_pcluster_t *const submit_qtail = qtail[JQ_SUBMIT];
1137 z_erofs_next_pcluster_t *const bypass_qtail = qtail[JQ_BYPASS];
1138
1139 DBG_BUGON(owned_head == Z_EROFS_PCLUSTER_TAIL_CLOSED);
1140 if (owned_head == Z_EROFS_PCLUSTER_TAIL)
1141 owned_head = Z_EROFS_PCLUSTER_TAIL_CLOSED;
1142
1143 WRITE_ONCE(pcl->next, Z_EROFS_PCLUSTER_TAIL_CLOSED);
1144
1145 WRITE_ONCE(*submit_qtail, owned_head);
1146 WRITE_ONCE(*bypass_qtail, &pcl->next);
1147
1148 qtail[JQ_BYPASS] = &pcl->next;
1149}
1150
1151static void z_erofs_submit_queue(struct super_block *sb,
1152 z_erofs_next_pcluster_t owned_head,
1153 struct list_head *pagepool,
1154 struct z_erofs_decompressqueue *fgq,
1155 bool *force_fg)
1156{
1157 struct erofs_sb_info *const sbi = EROFS_SB(sb);
1158 z_erofs_next_pcluster_t qtail[NR_JOBQUEUES];
1159 struct z_erofs_decompressqueue *q[NR_JOBQUEUES];
1160 void *bi_private;
1161
1162 pgoff_t uninitialized_var(last_index);
1163 unsigned int nr_bios = 0;
1164 struct bio *bio = NULL;
1165
1166 bi_private = jobqueueset_init(sb, q, fgq, force_fg);
1167 qtail[JQ_BYPASS] = &q[JQ_BYPASS]->head;
1168 qtail[JQ_SUBMIT] = &q[JQ_SUBMIT]->head;
1169
1170
1171 q[JQ_SUBMIT]->head = owned_head;
1172
1173 do {
1174 struct z_erofs_pcluster *pcl;
1175 pgoff_t cur, end;
1176 unsigned int i = 0;
1177 bool bypass = true;
1178
1179
1180 DBG_BUGON(owned_head == Z_EROFS_PCLUSTER_TAIL_CLOSED);
1181 DBG_BUGON(owned_head == Z_EROFS_PCLUSTER_NIL);
1182
1183 pcl = container_of(owned_head, struct z_erofs_pcluster, next);
1184
1185 cur = pcl->obj.index;
1186 end = cur + BIT(pcl->clusterbits);
1187
1188
1189 owned_head = cmpxchg(&pcl->next, Z_EROFS_PCLUSTER_TAIL,
1190 Z_EROFS_PCLUSTER_TAIL_CLOSED);
1191
1192 do {
1193 struct page *page;
1194 int err;
1195
1196 page = pickup_page_for_submission(pcl, i++, pagepool,
1197 MNGD_MAPPING(sbi),
1198 GFP_NOFS);
1199 if (!page)
1200 continue;
1201
1202 if (bio && cur != last_index + 1) {
1203submit_bio_retry:
1204 submit_bio(bio);
1205 bio = NULL;
1206 }
1207
1208 if (!bio) {
1209 bio = bio_alloc(GFP_NOIO, BIO_MAX_PAGES);
1210
1211 bio->bi_end_io = z_erofs_decompressqueue_endio;
1212 bio_set_dev(bio, sb->s_bdev);
1213 bio->bi_iter.bi_sector = (sector_t)cur <<
1214 LOG_SECTORS_PER_BLOCK;
1215 bio->bi_private = bi_private;
1216 bio->bi_opf = REQ_OP_READ;
1217 ++nr_bios;
1218 }
1219
1220 err = bio_add_page(bio, page, PAGE_SIZE, 0);
1221 if (err < PAGE_SIZE)
1222 goto submit_bio_retry;
1223
1224 last_index = cur;
1225 bypass = false;
1226 } while (++cur < end);
1227
1228 if (!bypass)
1229 qtail[JQ_SUBMIT] = &pcl->next;
1230 else
1231 move_to_bypass_jobqueue(pcl, qtail, owned_head);
1232 } while (owned_head != Z_EROFS_PCLUSTER_TAIL);
1233
1234 if (bio)
1235 submit_bio(bio);
1236
1237
1238
1239
1240
1241 if (!*force_fg && !nr_bios) {
1242 kvfree(q[JQ_SUBMIT]);
1243 return;
1244 }
1245 z_erofs_decompress_kickoff(q[JQ_SUBMIT], *force_fg, nr_bios);
1246}
1247
1248static void z_erofs_runqueue(struct super_block *sb,
1249 struct z_erofs_collector *clt,
1250 struct list_head *pagepool, bool force_fg)
1251{
1252 struct z_erofs_decompressqueue io[NR_JOBQUEUES];
1253
1254 if (clt->owned_head == Z_EROFS_PCLUSTER_TAIL)
1255 return;
1256 z_erofs_submit_queue(sb, clt->owned_head, pagepool, io, &force_fg);
1257
1258
1259 z_erofs_decompress_queue(&io[JQ_BYPASS], pagepool);
1260
1261 if (!force_fg)
1262 return;
1263
1264
1265 io_wait_event(io[JQ_SUBMIT].u.wait,
1266 !atomic_read(&io[JQ_SUBMIT].pending_bios));
1267
1268
1269 z_erofs_decompress_queue(&io[JQ_SUBMIT], pagepool);
1270}
1271
1272static int z_erofs_readpage(struct file *file, struct page *page)
1273{
1274 struct inode *const inode = page->mapping->host;
1275 struct z_erofs_decompress_frontend f = DECOMPRESS_FRONTEND_INIT(inode);
1276 int err;
1277 LIST_HEAD(pagepool);
1278
1279 trace_erofs_readpage(page, false);
1280
1281 f.headoffset = (erofs_off_t)page->index << PAGE_SHIFT;
1282
1283 err = z_erofs_do_read_page(&f, page, &pagepool);
1284 (void)z_erofs_collector_end(&f.clt);
1285
1286
1287 z_erofs_runqueue(inode->i_sb, &f.clt, &pagepool, true);
1288
1289 if (err)
1290 erofs_err(inode->i_sb, "failed to read, err [%d]", err);
1291
1292 if (f.map.mpage)
1293 put_page(f.map.mpage);
1294
1295
1296 put_pages_list(&pagepool);
1297 return err;
1298}
1299
1300static bool should_decompress_synchronously(struct erofs_sb_info *sbi,
1301 unsigned int nr)
1302{
1303 return nr <= sbi->max_sync_decompress_pages;
1304}
1305
1306static int z_erofs_readpages(struct file *filp, struct address_space *mapping,
1307 struct list_head *pages, unsigned int nr_pages)
1308{
1309 struct inode *const inode = mapping->host;
1310 struct erofs_sb_info *const sbi = EROFS_I_SB(inode);
1311
1312 bool sync = should_decompress_synchronously(sbi, nr_pages);
1313 struct z_erofs_decompress_frontend f = DECOMPRESS_FRONTEND_INIT(inode);
1314 gfp_t gfp = mapping_gfp_constraint(mapping, GFP_KERNEL);
1315 struct page *head = NULL;
1316 LIST_HEAD(pagepool);
1317
1318 trace_erofs_readpages(mapping->host, lru_to_page(pages),
1319 nr_pages, false);
1320
1321 f.headoffset = (erofs_off_t)lru_to_page(pages)->index << PAGE_SHIFT;
1322
1323 for (; nr_pages; --nr_pages) {
1324 struct page *page = lru_to_page(pages);
1325
1326 prefetchw(&page->flags);
1327 list_del(&page->lru);
1328
1329
1330
1331
1332
1333
1334 sync &= !(PageReadahead(page) && !head);
1335
1336 if (add_to_page_cache_lru(page, mapping, page->index, gfp)) {
1337 list_add(&page->lru, &pagepool);
1338 continue;
1339 }
1340
1341 set_page_private(page, (unsigned long)head);
1342 head = page;
1343 }
1344
1345 while (head) {
1346 struct page *page = head;
1347 int err;
1348
1349
1350 head = (void *)page_private(page);
1351
1352 err = z_erofs_do_read_page(&f, page, &pagepool);
1353 if (err)
1354 erofs_err(inode->i_sb,
1355 "readahead error at page %lu @ nid %llu",
1356 page->index, EROFS_I(inode)->nid);
1357 put_page(page);
1358 }
1359
1360 (void)z_erofs_collector_end(&f.clt);
1361
1362 z_erofs_runqueue(inode->i_sb, &f.clt, &pagepool, sync);
1363
1364 if (f.map.mpage)
1365 put_page(f.map.mpage);
1366
1367
1368 put_pages_list(&pagepool);
1369 return 0;
1370}
1371
1372const struct address_space_operations z_erofs_aops = {
1373 .readpage = z_erofs_readpage,
1374 .readpages = z_erofs_readpages,
1375};
1376
1377