xref: /openbmc/linux/fs/squashfs/block.c (revision bacf743e)
1 // SPDX-License-Identifier: GPL-2.0-or-later
2 /*
3  * Squashfs - a compressed read only filesystem for Linux
4  *
5  * Copyright (c) 2002, 2003, 2004, 2005, 2006, 2007, 2008
6  * Phillip Lougher <phillip@squashfs.org.uk>
7  *
8  * block.c
9  */
10 
11 /*
12  * This file implements the low-level routines to read and decompress
13  * datablocks and metadata blocks.
14  */
15 
16 #include <linux/blkdev.h>
17 #include <linux/fs.h>
18 #include <linux/vfs.h>
19 #include <linux/slab.h>
20 #include <linux/string.h>
21 #include <linux/buffer_head.h>
22 #include <linux/bio.h>
23 
24 #include "squashfs_fs.h"
25 #include "squashfs_fs_sb.h"
26 #include "squashfs.h"
27 #include "decompressor.h"
28 #include "page_actor.h"
29 
30 /*
31  * Returns the amount of bytes copied to the page actor.
32  */
33 static int copy_bio_to_actor(struct bio *bio,
34 			     struct squashfs_page_actor *actor,
35 			     int offset, int req_length)
36 {
37 	void *actor_addr = squashfs_first_page(actor);
38 	struct bvec_iter_all iter_all = {};
39 	struct bio_vec *bvec = bvec_init_iter_all(&iter_all);
40 	int copied_bytes = 0;
41 	int actor_offset = 0;
42 
43 	if (WARN_ON_ONCE(!bio_next_segment(bio, &iter_all)))
44 		return 0;
45 
46 	while (copied_bytes < req_length) {
47 		int bytes_to_copy = min_t(int, bvec->bv_len - offset,
48 					  PAGE_SIZE - actor_offset);
49 
50 		bytes_to_copy = min_t(int, bytes_to_copy,
51 				      req_length - copied_bytes);
52 		memcpy(actor_addr + actor_offset, bvec_virt(bvec) + offset,
53 		       bytes_to_copy);
54 
55 		actor_offset += bytes_to_copy;
56 		copied_bytes += bytes_to_copy;
57 		offset += bytes_to_copy;
58 
59 		if (actor_offset >= PAGE_SIZE) {
60 			actor_addr = squashfs_next_page(actor);
61 			if (!actor_addr)
62 				break;
63 			actor_offset = 0;
64 		}
65 		if (offset >= bvec->bv_len) {
66 			if (!bio_next_segment(bio, &iter_all))
67 				break;
68 			offset = 0;
69 		}
70 	}
71 	squashfs_finish_page(actor);
72 	return copied_bytes;
73 }
74 
75 static int squashfs_bio_read(struct super_block *sb, u64 index, int length,
76 			     struct bio **biop, int *block_offset)
77 {
78 	struct squashfs_sb_info *msblk = sb->s_fs_info;
79 	const u64 read_start = round_down(index, msblk->devblksize);
80 	const sector_t block = read_start >> msblk->devblksize_log2;
81 	const u64 read_end = round_up(index + length, msblk->devblksize);
82 	const sector_t block_end = read_end >> msblk->devblksize_log2;
83 	int offset = read_start - round_down(index, PAGE_SIZE);
84 	int total_len = (block_end - block) << msblk->devblksize_log2;
85 	const int page_count = DIV_ROUND_UP(total_len + offset, PAGE_SIZE);
86 	int error, i;
87 	struct bio *bio;
88 
89 	if (page_count <= BIO_MAX_VECS) {
90 		bio = bio_alloc(sb->s_bdev, page_count, REQ_OP_READ, GFP_NOIO);
91 	} else {
92 		bio = bio_kmalloc(GFP_NOIO, page_count);
93 		bio_set_dev(bio, sb->s_bdev);
94 		bio->bi_opf = REQ_OP_READ;
95 	}
96 
97 	if (!bio)
98 		return -ENOMEM;
99 
100 	bio->bi_iter.bi_sector = block * (msblk->devblksize >> SECTOR_SHIFT);
101 
102 	for (i = 0; i < page_count; ++i) {
103 		unsigned int len =
104 			min_t(unsigned int, PAGE_SIZE - offset, total_len);
105 		struct page *page = alloc_page(GFP_NOIO);
106 
107 		if (!page) {
108 			error = -ENOMEM;
109 			goto out_free_bio;
110 		}
111 		if (!bio_add_page(bio, page, len, offset)) {
112 			error = -EIO;
113 			goto out_free_bio;
114 		}
115 		offset = 0;
116 		total_len -= len;
117 	}
118 
119 	error = submit_bio_wait(bio);
120 	if (error)
121 		goto out_free_bio;
122 
123 	*biop = bio;
124 	*block_offset = index & ((1 << msblk->devblksize_log2) - 1);
125 	return 0;
126 
127 out_free_bio:
128 	bio_free_pages(bio);
129 	bio_put(bio);
130 	return error;
131 }
132 
133 /*
134  * Read and decompress a metadata block or datablock.  Length is non-zero
135  * if a datablock is being read (the size is stored elsewhere in the
136  * filesystem), otherwise the length is obtained from the first two bytes of
137  * the metadata block.  A bit in the length field indicates if the block
138  * is stored uncompressed in the filesystem (usually because compression
139  * generated a larger block - this does occasionally happen with compression
140  * algorithms).
141  */
142 int squashfs_read_data(struct super_block *sb, u64 index, int length,
143 		       u64 *next_index, struct squashfs_page_actor *output)
144 {
145 	struct squashfs_sb_info *msblk = sb->s_fs_info;
146 	struct bio *bio = NULL;
147 	int compressed;
148 	int res;
149 	int offset;
150 
151 	if (length) {
152 		/*
153 		 * Datablock.
154 		 */
155 		compressed = SQUASHFS_COMPRESSED_BLOCK(length);
156 		length = SQUASHFS_COMPRESSED_SIZE_BLOCK(length);
157 		TRACE("Block @ 0x%llx, %scompressed size %d, src size %d\n",
158 			index, compressed ? "" : "un", length, output->length);
159 	} else {
160 		/*
161 		 * Metadata block.
162 		 */
163 		const u8 *data;
164 		struct bvec_iter_all iter_all = {};
165 		struct bio_vec *bvec = bvec_init_iter_all(&iter_all);
166 
167 		if (index + 2 > msblk->bytes_used) {
168 			res = -EIO;
169 			goto out;
170 		}
171 		res = squashfs_bio_read(sb, index, 2, &bio, &offset);
172 		if (res)
173 			goto out;
174 
175 		if (WARN_ON_ONCE(!bio_next_segment(bio, &iter_all))) {
176 			res = -EIO;
177 			goto out_free_bio;
178 		}
179 		/* Extract the length of the metadata block */
180 		data = bvec_virt(bvec);
181 		length = data[offset];
182 		if (offset < bvec->bv_len - 1) {
183 			length |= data[offset + 1] << 8;
184 		} else {
185 			if (WARN_ON_ONCE(!bio_next_segment(bio, &iter_all))) {
186 				res = -EIO;
187 				goto out_free_bio;
188 			}
189 			data = bvec_virt(bvec);
190 			length |= data[0] << 8;
191 		}
192 		bio_free_pages(bio);
193 		bio_put(bio);
194 
195 		compressed = SQUASHFS_COMPRESSED(length);
196 		length = SQUASHFS_COMPRESSED_SIZE(length);
197 		index += 2;
198 
199 		TRACE("Block @ 0x%llx, %scompressed size %d\n", index - 2,
200 		      compressed ? "" : "un", length);
201 	}
202 	if (length < 0 || length > output->length ||
203 			(index + length) > msblk->bytes_used) {
204 		res = -EIO;
205 		goto out;
206 	}
207 
208 	if (next_index)
209 		*next_index = index + length;
210 
211 	res = squashfs_bio_read(sb, index, length, &bio, &offset);
212 	if (res)
213 		goto out;
214 
215 	if (compressed) {
216 		if (!msblk->stream) {
217 			res = -EIO;
218 			goto out_free_bio;
219 		}
220 		res = squashfs_decompress(msblk, bio, offset, length, output);
221 	} else {
222 		res = copy_bio_to_actor(bio, output, offset, length);
223 	}
224 
225 out_free_bio:
226 	bio_free_pages(bio);
227 	bio_put(bio);
228 out:
229 	if (res < 0) {
230 		ERROR("Failed to read block 0x%llx: %d\n", index, res);
231 		if (msblk->panic_on_errors)
232 			panic("squashfs read failed");
233 	}
234 
235 	return res;
236 }
237