162306a36Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0-only
262306a36Sopenharmony_ci/*
362306a36Sopenharmony_ci * Copyright (c) 2013
462306a36Sopenharmony_ci * Phillip Lougher <phillip@squashfs.org.uk>
562306a36Sopenharmony_ci */
662306a36Sopenharmony_ci
762306a36Sopenharmony_ci#include <linux/fs.h>
862306a36Sopenharmony_ci#include <linux/vfs.h>
962306a36Sopenharmony_ci#include <linux/kernel.h>
1062306a36Sopenharmony_ci#include <linux/slab.h>
1162306a36Sopenharmony_ci#include <linux/string.h>
1262306a36Sopenharmony_ci#include <linux/pagemap.h>
1362306a36Sopenharmony_ci#include <linux/mutex.h>
1462306a36Sopenharmony_ci
1562306a36Sopenharmony_ci#include "squashfs_fs.h"
1662306a36Sopenharmony_ci#include "squashfs_fs_sb.h"
1762306a36Sopenharmony_ci#include "squashfs_fs_i.h"
1862306a36Sopenharmony_ci#include "squashfs.h"
1962306a36Sopenharmony_ci#include "page_actor.h"
2062306a36Sopenharmony_ci
2162306a36Sopenharmony_ci/* Read separately compressed datablock directly into page cache */
2262306a36Sopenharmony_ciint squashfs_readpage_block(struct page *target_page, u64 block, int bsize,
2362306a36Sopenharmony_ci	int expected)
2462306a36Sopenharmony_ci
2562306a36Sopenharmony_ci{
2662306a36Sopenharmony_ci	struct inode *inode = target_page->mapping->host;
2762306a36Sopenharmony_ci	struct squashfs_sb_info *msblk = inode->i_sb->s_fs_info;
2862306a36Sopenharmony_ci
2962306a36Sopenharmony_ci	int file_end = (i_size_read(inode) - 1) >> PAGE_SHIFT;
3062306a36Sopenharmony_ci	int mask = (1 << (msblk->block_log - PAGE_SHIFT)) - 1;
3162306a36Sopenharmony_ci	int start_index = target_page->index & ~mask;
3262306a36Sopenharmony_ci	int end_index = start_index | mask;
3362306a36Sopenharmony_ci	int i, n, pages, bytes, res = -ENOMEM;
3462306a36Sopenharmony_ci	struct page **page;
3562306a36Sopenharmony_ci	struct squashfs_page_actor *actor;
3662306a36Sopenharmony_ci	void *pageaddr;
3762306a36Sopenharmony_ci
3862306a36Sopenharmony_ci	if (end_index > file_end)
3962306a36Sopenharmony_ci		end_index = file_end;
4062306a36Sopenharmony_ci
4162306a36Sopenharmony_ci	pages = end_index - start_index + 1;
4262306a36Sopenharmony_ci
4362306a36Sopenharmony_ci	page = kmalloc_array(pages, sizeof(void *), GFP_KERNEL);
4462306a36Sopenharmony_ci	if (page == NULL)
4562306a36Sopenharmony_ci		return res;
4662306a36Sopenharmony_ci
4762306a36Sopenharmony_ci	/* Try to grab all the pages covered by the Squashfs block */
4862306a36Sopenharmony_ci	for (i = 0, n = start_index; n <= end_index; n++) {
4962306a36Sopenharmony_ci		page[i] = (n == target_page->index) ? target_page :
5062306a36Sopenharmony_ci			grab_cache_page_nowait(target_page->mapping, n);
5162306a36Sopenharmony_ci
5262306a36Sopenharmony_ci		if (page[i] == NULL)
5362306a36Sopenharmony_ci			continue;
5462306a36Sopenharmony_ci
5562306a36Sopenharmony_ci		if (PageUptodate(page[i])) {
5662306a36Sopenharmony_ci			unlock_page(page[i]);
5762306a36Sopenharmony_ci			put_page(page[i]);
5862306a36Sopenharmony_ci			continue;
5962306a36Sopenharmony_ci		}
6062306a36Sopenharmony_ci
6162306a36Sopenharmony_ci		i++;
6262306a36Sopenharmony_ci	}
6362306a36Sopenharmony_ci
6462306a36Sopenharmony_ci	pages = i;
6562306a36Sopenharmony_ci
6662306a36Sopenharmony_ci	/*
6762306a36Sopenharmony_ci	 * Create a "page actor" which will kmap and kunmap the
6862306a36Sopenharmony_ci	 * page cache pages appropriately within the decompressor
6962306a36Sopenharmony_ci	 */
7062306a36Sopenharmony_ci	actor = squashfs_page_actor_init_special(msblk, page, pages, expected);
7162306a36Sopenharmony_ci	if (actor == NULL)
7262306a36Sopenharmony_ci		goto out;
7362306a36Sopenharmony_ci
7462306a36Sopenharmony_ci	/* Decompress directly into the page cache buffers */
7562306a36Sopenharmony_ci	res = squashfs_read_data(inode->i_sb, block, bsize, NULL, actor);
7662306a36Sopenharmony_ci
7762306a36Sopenharmony_ci	squashfs_page_actor_free(actor);
7862306a36Sopenharmony_ci
7962306a36Sopenharmony_ci	if (res < 0)
8062306a36Sopenharmony_ci		goto mark_errored;
8162306a36Sopenharmony_ci
8262306a36Sopenharmony_ci	if (res != expected) {
8362306a36Sopenharmony_ci		res = -EIO;
8462306a36Sopenharmony_ci		goto mark_errored;
8562306a36Sopenharmony_ci	}
8662306a36Sopenharmony_ci
8762306a36Sopenharmony_ci	/* Last page (if present) may have trailing bytes not filled */
8862306a36Sopenharmony_ci	bytes = res % PAGE_SIZE;
8962306a36Sopenharmony_ci	if (page[pages - 1]->index == end_index && bytes) {
9062306a36Sopenharmony_ci		pageaddr = kmap_local_page(page[pages - 1]);
9162306a36Sopenharmony_ci		memset(pageaddr + bytes, 0, PAGE_SIZE - bytes);
9262306a36Sopenharmony_ci		kunmap_local(pageaddr);
9362306a36Sopenharmony_ci	}
9462306a36Sopenharmony_ci
9562306a36Sopenharmony_ci	/* Mark pages as uptodate, unlock and release */
9662306a36Sopenharmony_ci	for (i = 0; i < pages; i++) {
9762306a36Sopenharmony_ci		flush_dcache_page(page[i]);
9862306a36Sopenharmony_ci		SetPageUptodate(page[i]);
9962306a36Sopenharmony_ci		unlock_page(page[i]);
10062306a36Sopenharmony_ci		if (page[i] != target_page)
10162306a36Sopenharmony_ci			put_page(page[i]);
10262306a36Sopenharmony_ci	}
10362306a36Sopenharmony_ci
10462306a36Sopenharmony_ci	kfree(page);
10562306a36Sopenharmony_ci
10662306a36Sopenharmony_ci	return 0;
10762306a36Sopenharmony_ci
10862306a36Sopenharmony_cimark_errored:
10962306a36Sopenharmony_ci	/* Decompression failed, mark pages as errored.  Target_page is
11062306a36Sopenharmony_ci	 * dealt with by the caller
11162306a36Sopenharmony_ci	 */
11262306a36Sopenharmony_ci	for (i = 0; i < pages; i++) {
11362306a36Sopenharmony_ci		if (page[i] == NULL || page[i] == target_page)
11462306a36Sopenharmony_ci			continue;
11562306a36Sopenharmony_ci		flush_dcache_page(page[i]);
11662306a36Sopenharmony_ci		SetPageError(page[i]);
11762306a36Sopenharmony_ci		unlock_page(page[i]);
11862306a36Sopenharmony_ci		put_page(page[i]);
11962306a36Sopenharmony_ci	}
12062306a36Sopenharmony_ci
12162306a36Sopenharmony_ciout:
12262306a36Sopenharmony_ci	kfree(page);
12362306a36Sopenharmony_ci	return res;
12462306a36Sopenharmony_ci}
125