Linux Audio

Check our new training course

Buildroot integration, development and maintenance

Need a Buildroot system for your embedded project?
Loading...
v6.8
  1// SPDX-License-Identifier: GPL-2.0
  2/*
  3 * Copyright (C) 2008 Oracle.  All rights reserved.
  4 *
  5 * Based on jffs2 zlib code:
  6 * Copyright © 2001-2007 Red Hat, Inc.
  7 * Created by David Woodhouse <dwmw2@infradead.org>
  8 */
  9
 10#include <linux/kernel.h>
 11#include <linux/slab.h>
 12#include <linux/zlib.h>
 13#include <linux/zutil.h>
 14#include <linux/mm.h>
 15#include <linux/init.h>
 16#include <linux/err.h>
 17#include <linux/sched.h>
 18#include <linux/pagemap.h>
 19#include <linux/bio.h>
 20#include <linux/refcount.h>
 21#include "compression.h"
 22
 23/* workspace buffer size for s390 zlib hardware support */
 24#define ZLIB_DFLTCC_BUF_SIZE    (4 * PAGE_SIZE)
 25
 26struct workspace {
 27	z_stream strm;
 28	char *buf;
 29	unsigned int buf_size;
 30	struct list_head list;
 31	int level;
 32};
 33
 34static struct workspace_manager wsm;
 35
 36struct list_head *zlib_get_workspace(unsigned int level)
 
 
 
 
 
 37{
 38	struct list_head *ws = btrfs_get_workspace(BTRFS_COMPRESS_ZLIB, level);
 
 
 
 
 
 39	struct workspace *workspace = list_entry(ws, struct workspace, list);
 40
 41	workspace->level = level;
 42
 43	return ws;
 44}
 45
 46void zlib_free_workspace(struct list_head *ws)
 
 
 
 
 
 47{
 48	struct workspace *workspace = list_entry(ws, struct workspace, list);
 49
 50	kvfree(workspace->strm.workspace);
 51	kfree(workspace->buf);
 52	kfree(workspace);
 53}
 54
 55struct list_head *zlib_alloc_workspace(unsigned int level)
 56{
 57	struct workspace *workspace;
 58	int workspacesize;
 59
 60	workspace = kzalloc(sizeof(*workspace), GFP_KERNEL);
 61	if (!workspace)
 62		return ERR_PTR(-ENOMEM);
 63
 64	workspacesize = max(zlib_deflate_workspacesize(MAX_WBITS, MAX_MEM_LEVEL),
 65			zlib_inflate_workspacesize());
 66	workspace->strm.workspace = kvzalloc(workspacesize, GFP_KERNEL | __GFP_NOWARN);
 67	workspace->level = level;
 68	workspace->buf = NULL;
 69	/*
 70	 * In case of s390 zlib hardware support, allocate lager workspace
 71	 * buffer. If allocator fails, fall back to a single page buffer.
 72	 */
 73	if (zlib_deflate_dfltcc_enabled()) {
 74		workspace->buf = kmalloc(ZLIB_DFLTCC_BUF_SIZE,
 75					 __GFP_NOMEMALLOC | __GFP_NORETRY |
 76					 __GFP_NOWARN | GFP_NOIO);
 77		workspace->buf_size = ZLIB_DFLTCC_BUF_SIZE;
 78	}
 79	if (!workspace->buf) {
 80		workspace->buf = kmalloc(PAGE_SIZE, GFP_KERNEL);
 81		workspace->buf_size = PAGE_SIZE;
 82	}
 83	if (!workspace->strm.workspace || !workspace->buf)
 84		goto fail;
 85
 86	INIT_LIST_HEAD(&workspace->list);
 87
 88	return &workspace->list;
 89fail:
 90	zlib_free_workspace(&workspace->list);
 91	return ERR_PTR(-ENOMEM);
 92}
 93
 94int zlib_compress_pages(struct list_head *ws, struct address_space *mapping,
 95		u64 start, struct page **pages, unsigned long *out_pages,
 96		unsigned long *total_in, unsigned long *total_out)
 
 
 
 
 97{
 98	struct workspace *workspace = list_entry(ws, struct workspace, list);
 99	int ret;
100	char *data_in = NULL;
101	char *cpage_out;
102	int nr_pages = 0;
103	struct page *in_page = NULL;
104	struct page *out_page = NULL;
105	unsigned long bytes_left;
106	unsigned int in_buf_pages;
107	unsigned long len = *total_out;
108	unsigned long nr_dest_pages = *out_pages;
109	const unsigned long max_out = nr_dest_pages * PAGE_SIZE;
110
111	*out_pages = 0;
112	*total_out = 0;
113	*total_in = 0;
114
115	if (Z_OK != zlib_deflateInit(&workspace->strm, workspace->level)) {
116		pr_warn("BTRFS: deflateInit failed\n");
117		ret = -EIO;
118		goto out;
119	}
120
121	workspace->strm.total_in = 0;
122	workspace->strm.total_out = 0;
123
124	out_page = btrfs_alloc_compr_page();
 
 
 
125	if (out_page == NULL) {
126		ret = -ENOMEM;
127		goto out;
128	}
129	cpage_out = page_address(out_page);
130	pages[0] = out_page;
131	nr_pages = 1;
132
133	workspace->strm.next_in = workspace->buf;
134	workspace->strm.avail_in = 0;
135	workspace->strm.next_out = cpage_out;
136	workspace->strm.avail_out = PAGE_SIZE;
 
137
138	while (workspace->strm.total_in < len) {
139		/*
140		 * Get next input pages and copy the contents to
141		 * the workspace buffer if required.
142		 */
143		if (workspace->strm.avail_in == 0) {
144			bytes_left = len - workspace->strm.total_in;
145			in_buf_pages = min(DIV_ROUND_UP(bytes_left, PAGE_SIZE),
146					   workspace->buf_size / PAGE_SIZE);
147			if (in_buf_pages > 1) {
148				int i;
149
150				for (i = 0; i < in_buf_pages; i++) {
151					if (data_in) {
152						kunmap_local(data_in);
153						put_page(in_page);
154					}
155					in_page = find_get_page(mapping,
156								start >> PAGE_SHIFT);
157					data_in = kmap_local_page(in_page);
158					copy_page(workspace->buf + i * PAGE_SIZE,
159						  data_in);
160					start += PAGE_SIZE;
161				}
162				workspace->strm.next_in = workspace->buf;
163			} else {
164				if (data_in) {
165					kunmap_local(data_in);
166					put_page(in_page);
167				}
168				in_page = find_get_page(mapping,
169							start >> PAGE_SHIFT);
170				data_in = kmap_local_page(in_page);
171				start += PAGE_SIZE;
172				workspace->strm.next_in = data_in;
173			}
174			workspace->strm.avail_in = min(bytes_left,
175						       (unsigned long) workspace->buf_size);
176		}
177
178		ret = zlib_deflate(&workspace->strm, Z_SYNC_FLUSH);
179		if (ret != Z_OK) {
180			pr_debug("BTRFS: deflate in loop returned %d\n",
181			       ret);
182			zlib_deflateEnd(&workspace->strm);
183			ret = -EIO;
184			goto out;
185		}
186
187		/* we're making it bigger, give up */
188		if (workspace->strm.total_in > 8192 &&
189		    workspace->strm.total_in <
190		    workspace->strm.total_out) {
191			ret = -E2BIG;
192			goto out;
193		}
194		/* we need another page for writing out.  Test this
195		 * before the total_in so we will pull in a new page for
196		 * the stream end if required
197		 */
198		if (workspace->strm.avail_out == 0) {
 
199			if (nr_pages == nr_dest_pages) {
 
200				ret = -E2BIG;
201				goto out;
202			}
203			out_page = btrfs_alloc_compr_page();
204			if (out_page == NULL) {
205				ret = -ENOMEM;
206				goto out;
207			}
208			cpage_out = page_address(out_page);
209			pages[nr_pages] = out_page;
210			nr_pages++;
211			workspace->strm.avail_out = PAGE_SIZE;
212			workspace->strm.next_out = cpage_out;
213		}
214		/* we're all done */
215		if (workspace->strm.total_in >= len)
216			break;
217		if (workspace->strm.total_out > max_out)
218			break;
219	}
220	workspace->strm.avail_in = 0;
221	/*
222	 * Call deflate with Z_FINISH flush parameter providing more output
223	 * space but no more input data, until it returns with Z_STREAM_END.
224	 */
225	while (ret != Z_STREAM_END) {
226		ret = zlib_deflate(&workspace->strm, Z_FINISH);
227		if (ret == Z_STREAM_END)
228			break;
229		if (ret != Z_OK && ret != Z_BUF_ERROR) {
230			zlib_deflateEnd(&workspace->strm);
231			ret = -EIO;
232			goto out;
233		} else if (workspace->strm.avail_out == 0) {
234			/* get another page for the stream end */
235			if (nr_pages == nr_dest_pages) {
236				ret = -E2BIG;
237				goto out;
238			}
239			out_page = btrfs_alloc_compr_page();
240			if (out_page == NULL) {
241				ret = -ENOMEM;
242				goto out;
243			}
244			cpage_out = page_address(out_page);
245			pages[nr_pages] = out_page;
246			nr_pages++;
247			workspace->strm.avail_out = PAGE_SIZE;
248			workspace->strm.next_out = cpage_out;
249		}
250	}
 
 
251	zlib_deflateEnd(&workspace->strm);
252
 
 
 
 
 
253	if (workspace->strm.total_out >= workspace->strm.total_in) {
254		ret = -E2BIG;
255		goto out;
256	}
257
258	ret = 0;
259	*total_out = workspace->strm.total_out;
260	*total_in = workspace->strm.total_in;
261out:
262	*out_pages = nr_pages;
263	if (data_in) {
264		kunmap_local(data_in);
 
 
 
265		put_page(in_page);
266	}
267
268	return ret;
269}
270
271int zlib_decompress_bio(struct list_head *ws, struct compressed_bio *cb)
272{
273	struct workspace *workspace = list_entry(ws, struct workspace, list);
274	int ret = 0, ret2;
275	int wbits = MAX_WBITS;
276	char *data_in;
277	size_t total_out = 0;
278	unsigned long page_in_index = 0;
279	size_t srclen = cb->compressed_len;
280	unsigned long total_pages_in = DIV_ROUND_UP(srclen, PAGE_SIZE);
281	unsigned long buf_start;
282	struct page **pages_in = cb->compressed_pages;
 
 
283
284	data_in = kmap_local_page(pages_in[page_in_index]);
285	workspace->strm.next_in = data_in;
286	workspace->strm.avail_in = min_t(size_t, srclen, PAGE_SIZE);
287	workspace->strm.total_in = 0;
288
289	workspace->strm.total_out = 0;
290	workspace->strm.next_out = workspace->buf;
291	workspace->strm.avail_out = workspace->buf_size;
292
293	/* If it's deflate, and it's got no preset dictionary, then
294	   we can tell zlib to skip the adler32 check. */
295	if (srclen > 2 && !(data_in[1] & PRESET_DICT) &&
296	    ((data_in[0] & 0x0f) == Z_DEFLATED) &&
297	    !(((data_in[0]<<8) + data_in[1]) % 31)) {
298
299		wbits = -((data_in[0] >> 4) + 8);
300		workspace->strm.next_in += 2;
301		workspace->strm.avail_in -= 2;
302	}
303
304	if (Z_OK != zlib_inflateInit2(&workspace->strm, wbits)) {
305		pr_warn("BTRFS: inflateInit failed\n");
306		kunmap_local(data_in);
307		return -EIO;
308	}
309	while (workspace->strm.total_in < srclen) {
310		ret = zlib_inflate(&workspace->strm, Z_NO_FLUSH);
311		if (ret != Z_OK && ret != Z_STREAM_END)
312			break;
313
314		buf_start = total_out;
315		total_out = workspace->strm.total_out;
316
317		/* we didn't make progress in this inflate call, we're done */
318		if (buf_start == total_out)
319			break;
320
321		ret2 = btrfs_decompress_buf2page(workspace->buf,
322				total_out - buf_start, cb, buf_start);
 
323		if (ret2 == 0) {
324			ret = 0;
325			goto done;
326		}
327
328		workspace->strm.next_out = workspace->buf;
329		workspace->strm.avail_out = workspace->buf_size;
330
331		if (workspace->strm.avail_in == 0) {
332			unsigned long tmp;
333			kunmap_local(data_in);
334			page_in_index++;
335			if (page_in_index >= total_pages_in) {
336				data_in = NULL;
337				break;
338			}
339			data_in = kmap_local_page(pages_in[page_in_index]);
340			workspace->strm.next_in = data_in;
341			tmp = srclen - workspace->strm.total_in;
342			workspace->strm.avail_in = min(tmp, PAGE_SIZE);
 
343		}
344	}
345	if (ret != Z_STREAM_END)
346		ret = -EIO;
347	else
348		ret = 0;
349done:
350	zlib_inflateEnd(&workspace->strm);
351	if (data_in)
352		kunmap_local(data_in);
 
 
353	return ret;
354}
355
356int zlib_decompress(struct list_head *ws, const u8 *data_in,
357		struct page *dest_page, unsigned long dest_pgoff, size_t srclen,
358		size_t destlen)
 
359{
360	struct workspace *workspace = list_entry(ws, struct workspace, list);
361	int ret = 0;
362	int wbits = MAX_WBITS;
363	unsigned long to_copy;
 
 
 
 
 
 
364
365	workspace->strm.next_in = data_in;
366	workspace->strm.avail_in = srclen;
367	workspace->strm.total_in = 0;
368
369	workspace->strm.next_out = workspace->buf;
370	workspace->strm.avail_out = workspace->buf_size;
371	workspace->strm.total_out = 0;
372	/* If it's deflate, and it's got no preset dictionary, then
373	   we can tell zlib to skip the adler32 check. */
374	if (srclen > 2 && !(data_in[1] & PRESET_DICT) &&
375	    ((data_in[0] & 0x0f) == Z_DEFLATED) &&
376	    !(((data_in[0]<<8) + data_in[1]) % 31)) {
377
378		wbits = -((data_in[0] >> 4) + 8);
379		workspace->strm.next_in += 2;
380		workspace->strm.avail_in -= 2;
381	}
382
383	if (Z_OK != zlib_inflateInit2(&workspace->strm, wbits)) {
384		pr_warn("BTRFS: inflateInit failed\n");
385		return -EIO;
386	}
387
388	/*
389	 * Everything (in/out buf) should be at most one sector, there should
390	 * be no need to switch any input/output buffer.
391	 */
392	ret = zlib_inflate(&workspace->strm, Z_FINISH);
393	to_copy = min(workspace->strm.total_out, destlen);
394	if (ret != Z_STREAM_END)
395		goto out;
396
397	memcpy_to_page(dest_page, dest_pgoff, workspace->buf, to_copy);
 
 
398
399out:
400	if (unlikely(to_copy != destlen)) {
401		pr_warn_ratelimited("BTRFS: infalte failed, decompressed=%lu expected=%zu\n",
402					to_copy, destlen);
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
403		ret = -EIO;
404	} else {
405		ret = 0;
406	}
407
408	zlib_inflateEnd(&workspace->strm);
409
410	if (unlikely(to_copy < destlen))
411		memzero_page(dest_page, dest_pgoff + to_copy, destlen - to_copy);
 
 
 
 
 
 
 
 
412	return ret;
413}
414
415const struct btrfs_compress_op btrfs_zlib_compress = {
416	.workspace_manager	= &wsm,
 
 
 
 
 
 
 
 
417	.max_level		= 9,
418	.default_level		= BTRFS_ZLIB_DEFAULT_LEVEL,
419};
v5.4
  1// SPDX-License-Identifier: GPL-2.0
  2/*
  3 * Copyright (C) 2008 Oracle.  All rights reserved.
  4 *
  5 * Based on jffs2 zlib code:
  6 * Copyright © 2001-2007 Red Hat, Inc.
  7 * Created by David Woodhouse <dwmw2@infradead.org>
  8 */
  9
 10#include <linux/kernel.h>
 11#include <linux/slab.h>
 12#include <linux/zlib.h>
 13#include <linux/zutil.h>
 14#include <linux/mm.h>
 15#include <linux/init.h>
 16#include <linux/err.h>
 17#include <linux/sched.h>
 18#include <linux/pagemap.h>
 19#include <linux/bio.h>
 20#include <linux/refcount.h>
 21#include "compression.h"
 22
 
 
 
 23struct workspace {
 24	z_stream strm;
 25	char *buf;
 
 26	struct list_head list;
 27	int level;
 28};
 29
 30static struct workspace_manager wsm;
 31
 32static void zlib_init_workspace_manager(void)
 33{
 34	btrfs_init_workspace_manager(&wsm, &btrfs_zlib_compress);
 35}
 36
 37static void zlib_cleanup_workspace_manager(void)
 38{
 39	btrfs_cleanup_workspace_manager(&wsm);
 40}
 41
 42static struct list_head *zlib_get_workspace(unsigned int level)
 43{
 44	struct list_head *ws = btrfs_get_workspace(&wsm, level);
 45	struct workspace *workspace = list_entry(ws, struct workspace, list);
 46
 47	workspace->level = level;
 48
 49	return ws;
 50}
 51
 52static void zlib_put_workspace(struct list_head *ws)
 53{
 54	btrfs_put_workspace(&wsm, ws);
 55}
 56
 57static void zlib_free_workspace(struct list_head *ws)
 58{
 59	struct workspace *workspace = list_entry(ws, struct workspace, list);
 60
 61	kvfree(workspace->strm.workspace);
 62	kfree(workspace->buf);
 63	kfree(workspace);
 64}
 65
 66static struct list_head *zlib_alloc_workspace(unsigned int level)
 67{
 68	struct workspace *workspace;
 69	int workspacesize;
 70
 71	workspace = kzalloc(sizeof(*workspace), GFP_KERNEL);
 72	if (!workspace)
 73		return ERR_PTR(-ENOMEM);
 74
 75	workspacesize = max(zlib_deflate_workspacesize(MAX_WBITS, MAX_MEM_LEVEL),
 76			zlib_inflate_workspacesize());
 77	workspace->strm.workspace = kvmalloc(workspacesize, GFP_KERNEL);
 78	workspace->level = level;
 79	workspace->buf = kmalloc(PAGE_SIZE, GFP_KERNEL);
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 80	if (!workspace->strm.workspace || !workspace->buf)
 81		goto fail;
 82
 83	INIT_LIST_HEAD(&workspace->list);
 84
 85	return &workspace->list;
 86fail:
 87	zlib_free_workspace(&workspace->list);
 88	return ERR_PTR(-ENOMEM);
 89}
 90
 91static int zlib_compress_pages(struct list_head *ws,
 92			       struct address_space *mapping,
 93			       u64 start,
 94			       struct page **pages,
 95			       unsigned long *out_pages,
 96			       unsigned long *total_in,
 97			       unsigned long *total_out)
 98{
 99	struct workspace *workspace = list_entry(ws, struct workspace, list);
100	int ret;
101	char *data_in;
102	char *cpage_out;
103	int nr_pages = 0;
104	struct page *in_page = NULL;
105	struct page *out_page = NULL;
106	unsigned long bytes_left;
 
107	unsigned long len = *total_out;
108	unsigned long nr_dest_pages = *out_pages;
109	const unsigned long max_out = nr_dest_pages * PAGE_SIZE;
110
111	*out_pages = 0;
112	*total_out = 0;
113	*total_in = 0;
114
115	if (Z_OK != zlib_deflateInit(&workspace->strm, workspace->level)) {
116		pr_warn("BTRFS: deflateInit failed\n");
117		ret = -EIO;
118		goto out;
119	}
120
121	workspace->strm.total_in = 0;
122	workspace->strm.total_out = 0;
123
124	in_page = find_get_page(mapping, start >> PAGE_SHIFT);
125	data_in = kmap(in_page);
126
127	out_page = alloc_page(GFP_NOFS | __GFP_HIGHMEM);
128	if (out_page == NULL) {
129		ret = -ENOMEM;
130		goto out;
131	}
132	cpage_out = kmap(out_page);
133	pages[0] = out_page;
134	nr_pages = 1;
135
136	workspace->strm.next_in = data_in;
 
137	workspace->strm.next_out = cpage_out;
138	workspace->strm.avail_out = PAGE_SIZE;
139	workspace->strm.avail_in = min(len, PAGE_SIZE);
140
141	while (workspace->strm.total_in < len) {
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
142		ret = zlib_deflate(&workspace->strm, Z_SYNC_FLUSH);
143		if (ret != Z_OK) {
144			pr_debug("BTRFS: deflate in loop returned %d\n",
145			       ret);
146			zlib_deflateEnd(&workspace->strm);
147			ret = -EIO;
148			goto out;
149		}
150
151		/* we're making it bigger, give up */
152		if (workspace->strm.total_in > 8192 &&
153		    workspace->strm.total_in <
154		    workspace->strm.total_out) {
155			ret = -E2BIG;
156			goto out;
157		}
158		/* we need another page for writing out.  Test this
159		 * before the total_in so we will pull in a new page for
160		 * the stream end if required
161		 */
162		if (workspace->strm.avail_out == 0) {
163			kunmap(out_page);
164			if (nr_pages == nr_dest_pages) {
165				out_page = NULL;
166				ret = -E2BIG;
167				goto out;
168			}
169			out_page = alloc_page(GFP_NOFS | __GFP_HIGHMEM);
170			if (out_page == NULL) {
171				ret = -ENOMEM;
172				goto out;
173			}
174			cpage_out = kmap(out_page);
175			pages[nr_pages] = out_page;
176			nr_pages++;
177			workspace->strm.avail_out = PAGE_SIZE;
178			workspace->strm.next_out = cpage_out;
179		}
180		/* we're all done */
181		if (workspace->strm.total_in >= len)
182			break;
183
184		/* we've read in a full page, get a new one */
185		if (workspace->strm.avail_in == 0) {
186			if (workspace->strm.total_out > max_out)
187				break;
188
189			bytes_left = len - workspace->strm.total_in;
190			kunmap(in_page);
191			put_page(in_page);
192
193			start += PAGE_SIZE;
194			in_page = find_get_page(mapping,
195						start >> PAGE_SHIFT);
196			data_in = kmap(in_page);
197			workspace->strm.avail_in = min(bytes_left,
198							   PAGE_SIZE);
199			workspace->strm.next_in = data_in;
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
200		}
201	}
202	workspace->strm.avail_in = 0;
203	ret = zlib_deflate(&workspace->strm, Z_FINISH);
204	zlib_deflateEnd(&workspace->strm);
205
206	if (ret != Z_STREAM_END) {
207		ret = -EIO;
208		goto out;
209	}
210
211	if (workspace->strm.total_out >= workspace->strm.total_in) {
212		ret = -E2BIG;
213		goto out;
214	}
215
216	ret = 0;
217	*total_out = workspace->strm.total_out;
218	*total_in = workspace->strm.total_in;
219out:
220	*out_pages = nr_pages;
221	if (out_page)
222		kunmap(out_page);
223
224	if (in_page) {
225		kunmap(in_page);
226		put_page(in_page);
227	}
 
228	return ret;
229}
230
231static int zlib_decompress_bio(struct list_head *ws, struct compressed_bio *cb)
232{
233	struct workspace *workspace = list_entry(ws, struct workspace, list);
234	int ret = 0, ret2;
235	int wbits = MAX_WBITS;
236	char *data_in;
237	size_t total_out = 0;
238	unsigned long page_in_index = 0;
239	size_t srclen = cb->compressed_len;
240	unsigned long total_pages_in = DIV_ROUND_UP(srclen, PAGE_SIZE);
241	unsigned long buf_start;
242	struct page **pages_in = cb->compressed_pages;
243	u64 disk_start = cb->start;
244	struct bio *orig_bio = cb->orig_bio;
245
246	data_in = kmap(pages_in[page_in_index]);
247	workspace->strm.next_in = data_in;
248	workspace->strm.avail_in = min_t(size_t, srclen, PAGE_SIZE);
249	workspace->strm.total_in = 0;
250
251	workspace->strm.total_out = 0;
252	workspace->strm.next_out = workspace->buf;
253	workspace->strm.avail_out = PAGE_SIZE;
254
255	/* If it's deflate, and it's got no preset dictionary, then
256	   we can tell zlib to skip the adler32 check. */
257	if (srclen > 2 && !(data_in[1] & PRESET_DICT) &&
258	    ((data_in[0] & 0x0f) == Z_DEFLATED) &&
259	    !(((data_in[0]<<8) + data_in[1]) % 31)) {
260
261		wbits = -((data_in[0] >> 4) + 8);
262		workspace->strm.next_in += 2;
263		workspace->strm.avail_in -= 2;
264	}
265
266	if (Z_OK != zlib_inflateInit2(&workspace->strm, wbits)) {
267		pr_warn("BTRFS: inflateInit failed\n");
268		kunmap(pages_in[page_in_index]);
269		return -EIO;
270	}
271	while (workspace->strm.total_in < srclen) {
272		ret = zlib_inflate(&workspace->strm, Z_NO_FLUSH);
273		if (ret != Z_OK && ret != Z_STREAM_END)
274			break;
275
276		buf_start = total_out;
277		total_out = workspace->strm.total_out;
278
279		/* we didn't make progress in this inflate call, we're done */
280		if (buf_start == total_out)
281			break;
282
283		ret2 = btrfs_decompress_buf2page(workspace->buf, buf_start,
284						 total_out, disk_start,
285						 orig_bio);
286		if (ret2 == 0) {
287			ret = 0;
288			goto done;
289		}
290
291		workspace->strm.next_out = workspace->buf;
292		workspace->strm.avail_out = PAGE_SIZE;
293
294		if (workspace->strm.avail_in == 0) {
295			unsigned long tmp;
296			kunmap(pages_in[page_in_index]);
297			page_in_index++;
298			if (page_in_index >= total_pages_in) {
299				data_in = NULL;
300				break;
301			}
302			data_in = kmap(pages_in[page_in_index]);
303			workspace->strm.next_in = data_in;
304			tmp = srclen - workspace->strm.total_in;
305			workspace->strm.avail_in = min(tmp,
306							   PAGE_SIZE);
307		}
308	}
309	if (ret != Z_STREAM_END)
310		ret = -EIO;
311	else
312		ret = 0;
313done:
314	zlib_inflateEnd(&workspace->strm);
315	if (data_in)
316		kunmap(pages_in[page_in_index]);
317	if (!ret)
318		zero_fill_bio(orig_bio);
319	return ret;
320}
321
322static int zlib_decompress(struct list_head *ws, unsigned char *data_in,
323			   struct page *dest_page,
324			   unsigned long start_byte,
325			   size_t srclen, size_t destlen)
326{
327	struct workspace *workspace = list_entry(ws, struct workspace, list);
328	int ret = 0;
329	int wbits = MAX_WBITS;
330	unsigned long bytes_left;
331	unsigned long total_out = 0;
332	unsigned long pg_offset = 0;
333	char *kaddr;
334
335	destlen = min_t(unsigned long, destlen, PAGE_SIZE);
336	bytes_left = destlen;
337
338	workspace->strm.next_in = data_in;
339	workspace->strm.avail_in = srclen;
340	workspace->strm.total_in = 0;
341
342	workspace->strm.next_out = workspace->buf;
343	workspace->strm.avail_out = PAGE_SIZE;
344	workspace->strm.total_out = 0;
345	/* If it's deflate, and it's got no preset dictionary, then
346	   we can tell zlib to skip the adler32 check. */
347	if (srclen > 2 && !(data_in[1] & PRESET_DICT) &&
348	    ((data_in[0] & 0x0f) == Z_DEFLATED) &&
349	    !(((data_in[0]<<8) + data_in[1]) % 31)) {
350
351		wbits = -((data_in[0] >> 4) + 8);
352		workspace->strm.next_in += 2;
353		workspace->strm.avail_in -= 2;
354	}
355
356	if (Z_OK != zlib_inflateInit2(&workspace->strm, wbits)) {
357		pr_warn("BTRFS: inflateInit failed\n");
358		return -EIO;
359	}
360
361	while (bytes_left > 0) {
362		unsigned long buf_start;
363		unsigned long buf_offset;
364		unsigned long bytes;
 
 
 
 
365
366		ret = zlib_inflate(&workspace->strm, Z_NO_FLUSH);
367		if (ret != Z_OK && ret != Z_STREAM_END)
368			break;
369
370		buf_start = total_out;
371		total_out = workspace->strm.total_out;
372
373		if (total_out == buf_start) {
374			ret = -EIO;
375			break;
376		}
377
378		if (total_out <= start_byte)
379			goto next;
380
381		if (total_out > start_byte && buf_start < start_byte)
382			buf_offset = start_byte - buf_start;
383		else
384			buf_offset = 0;
385
386		bytes = min(PAGE_SIZE - pg_offset,
387			    PAGE_SIZE - buf_offset);
388		bytes = min(bytes, bytes_left);
389
390		kaddr = kmap_atomic(dest_page);
391		memcpy(kaddr + pg_offset, workspace->buf + buf_offset, bytes);
392		kunmap_atomic(kaddr);
393
394		pg_offset += bytes;
395		bytes_left -= bytes;
396next:
397		workspace->strm.next_out = workspace->buf;
398		workspace->strm.avail_out = PAGE_SIZE;
399	}
400
401	if (ret != Z_STREAM_END && bytes_left != 0)
402		ret = -EIO;
403	else
404		ret = 0;
 
405
406	zlib_inflateEnd(&workspace->strm);
407
408	/*
409	 * this should only happen if zlib returned fewer bytes than we
410	 * expected.  btrfs_get_block is responsible for zeroing from the
411	 * end of the inline extent (destlen) to the end of the page
412	 */
413	if (pg_offset < destlen) {
414		kaddr = kmap_atomic(dest_page);
415		memset(kaddr + pg_offset, 0, destlen - pg_offset);
416		kunmap_atomic(kaddr);
417	}
418	return ret;
419}
420
421const struct btrfs_compress_op btrfs_zlib_compress = {
422	.init_workspace_manager	= zlib_init_workspace_manager,
423	.cleanup_workspace_manager = zlib_cleanup_workspace_manager,
424	.get_workspace		= zlib_get_workspace,
425	.put_workspace		= zlib_put_workspace,
426	.alloc_workspace	= zlib_alloc_workspace,
427	.free_workspace		= zlib_free_workspace,
428	.compress_pages		= zlib_compress_pages,
429	.decompress_bio		= zlib_decompress_bio,
430	.decompress		= zlib_decompress,
431	.max_level		= 9,
432	.default_level		= BTRFS_ZLIB_DEFAULT_LEVEL,
433};