162306a36Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0-only 262306a36Sopenharmony_ci/* 362306a36Sopenharmony_ci * Copyright (c) 2013, 2014 462306a36Sopenharmony_ci * Phillip Lougher <phillip@squashfs.org.uk> 562306a36Sopenharmony_ci */ 662306a36Sopenharmony_ci 762306a36Sopenharmony_ci#include <linux/bio.h> 862306a36Sopenharmony_ci#include <linux/mutex.h> 962306a36Sopenharmony_ci#include <linux/slab.h> 1062306a36Sopenharmony_ci#include <linux/vmalloc.h> 1162306a36Sopenharmony_ci#include <linux/lz4.h> 1262306a36Sopenharmony_ci 1362306a36Sopenharmony_ci#include "squashfs_fs.h" 1462306a36Sopenharmony_ci#include "squashfs_fs_sb.h" 1562306a36Sopenharmony_ci#include "squashfs.h" 1662306a36Sopenharmony_ci#include "decompressor.h" 1762306a36Sopenharmony_ci#include "page_actor.h" 1862306a36Sopenharmony_ci 1962306a36Sopenharmony_ci#define LZ4_LEGACY 1 2062306a36Sopenharmony_ci 2162306a36Sopenharmony_cistruct lz4_comp_opts { 2262306a36Sopenharmony_ci __le32 version; 2362306a36Sopenharmony_ci __le32 flags; 2462306a36Sopenharmony_ci}; 2562306a36Sopenharmony_ci 2662306a36Sopenharmony_cistruct squashfs_lz4 { 2762306a36Sopenharmony_ci void *input; 2862306a36Sopenharmony_ci void *output; 2962306a36Sopenharmony_ci}; 3062306a36Sopenharmony_ci 3162306a36Sopenharmony_ci 3262306a36Sopenharmony_cistatic void *lz4_comp_opts(struct squashfs_sb_info *msblk, 3362306a36Sopenharmony_ci void *buff, int len) 3462306a36Sopenharmony_ci{ 3562306a36Sopenharmony_ci struct lz4_comp_opts *comp_opts = buff; 3662306a36Sopenharmony_ci 3762306a36Sopenharmony_ci /* LZ4 compressed filesystems always have compression options */ 3862306a36Sopenharmony_ci if (comp_opts == NULL || len < sizeof(*comp_opts)) 3962306a36Sopenharmony_ci return ERR_PTR(-EIO); 4062306a36Sopenharmony_ci 4162306a36Sopenharmony_ci if (le32_to_cpu(comp_opts->version) != LZ4_LEGACY) { 4262306a36Sopenharmony_ci /* LZ4 format currently used by the kernel is the 'legacy' 4362306a36Sopenharmony_ci * format */ 4462306a36Sopenharmony_ci ERROR("Unknown LZ4 version\n"); 4562306a36Sopenharmony_ci return ERR_PTR(-EINVAL); 4662306a36Sopenharmony_ci } 4762306a36Sopenharmony_ci 4862306a36Sopenharmony_ci return NULL; 4962306a36Sopenharmony_ci} 5062306a36Sopenharmony_ci 5162306a36Sopenharmony_ci 5262306a36Sopenharmony_cistatic void *lz4_init(struct squashfs_sb_info *msblk, void *buff) 5362306a36Sopenharmony_ci{ 5462306a36Sopenharmony_ci int block_size = max_t(int, msblk->block_size, SQUASHFS_METADATA_SIZE); 5562306a36Sopenharmony_ci struct squashfs_lz4 *stream; 5662306a36Sopenharmony_ci 5762306a36Sopenharmony_ci stream = kzalloc(sizeof(*stream), GFP_KERNEL); 5862306a36Sopenharmony_ci if (stream == NULL) 5962306a36Sopenharmony_ci goto failed; 6062306a36Sopenharmony_ci stream->input = vmalloc(block_size); 6162306a36Sopenharmony_ci if (stream->input == NULL) 6262306a36Sopenharmony_ci goto failed2; 6362306a36Sopenharmony_ci stream->output = vmalloc(block_size); 6462306a36Sopenharmony_ci if (stream->output == NULL) 6562306a36Sopenharmony_ci goto failed3; 6662306a36Sopenharmony_ci 6762306a36Sopenharmony_ci return stream; 6862306a36Sopenharmony_ci 6962306a36Sopenharmony_cifailed3: 7062306a36Sopenharmony_ci vfree(stream->input); 7162306a36Sopenharmony_cifailed2: 7262306a36Sopenharmony_ci kfree(stream); 7362306a36Sopenharmony_cifailed: 7462306a36Sopenharmony_ci ERROR("Failed to initialise LZ4 decompressor\n"); 7562306a36Sopenharmony_ci return ERR_PTR(-ENOMEM); 7662306a36Sopenharmony_ci} 7762306a36Sopenharmony_ci 7862306a36Sopenharmony_ci 7962306a36Sopenharmony_cistatic void lz4_free(void *strm) 8062306a36Sopenharmony_ci{ 8162306a36Sopenharmony_ci struct squashfs_lz4 *stream = strm; 8262306a36Sopenharmony_ci 8362306a36Sopenharmony_ci if (stream) { 8462306a36Sopenharmony_ci vfree(stream->input); 8562306a36Sopenharmony_ci vfree(stream->output); 8662306a36Sopenharmony_ci } 8762306a36Sopenharmony_ci kfree(stream); 8862306a36Sopenharmony_ci} 8962306a36Sopenharmony_ci 9062306a36Sopenharmony_ci 9162306a36Sopenharmony_cistatic int lz4_uncompress(struct squashfs_sb_info *msblk, void *strm, 9262306a36Sopenharmony_ci struct bio *bio, int offset, int length, 9362306a36Sopenharmony_ci struct squashfs_page_actor *output) 9462306a36Sopenharmony_ci{ 9562306a36Sopenharmony_ci struct bvec_iter_all iter_all = {}; 9662306a36Sopenharmony_ci struct bio_vec *bvec = bvec_init_iter_all(&iter_all); 9762306a36Sopenharmony_ci struct squashfs_lz4 *stream = strm; 9862306a36Sopenharmony_ci void *buff = stream->input, *data; 9962306a36Sopenharmony_ci int bytes = length, res; 10062306a36Sopenharmony_ci 10162306a36Sopenharmony_ci while (bio_next_segment(bio, &iter_all)) { 10262306a36Sopenharmony_ci int avail = min(bytes, ((int)bvec->bv_len) - offset); 10362306a36Sopenharmony_ci 10462306a36Sopenharmony_ci data = bvec_virt(bvec); 10562306a36Sopenharmony_ci memcpy(buff, data + offset, avail); 10662306a36Sopenharmony_ci buff += avail; 10762306a36Sopenharmony_ci bytes -= avail; 10862306a36Sopenharmony_ci offset = 0; 10962306a36Sopenharmony_ci } 11062306a36Sopenharmony_ci 11162306a36Sopenharmony_ci res = LZ4_decompress_safe(stream->input, stream->output, 11262306a36Sopenharmony_ci length, output->length); 11362306a36Sopenharmony_ci 11462306a36Sopenharmony_ci if (res < 0) 11562306a36Sopenharmony_ci return -EIO; 11662306a36Sopenharmony_ci 11762306a36Sopenharmony_ci bytes = res; 11862306a36Sopenharmony_ci data = squashfs_first_page(output); 11962306a36Sopenharmony_ci buff = stream->output; 12062306a36Sopenharmony_ci while (data) { 12162306a36Sopenharmony_ci if (bytes <= PAGE_SIZE) { 12262306a36Sopenharmony_ci if (!IS_ERR(data)) 12362306a36Sopenharmony_ci memcpy(data, buff, bytes); 12462306a36Sopenharmony_ci break; 12562306a36Sopenharmony_ci } 12662306a36Sopenharmony_ci if (!IS_ERR(data)) 12762306a36Sopenharmony_ci memcpy(data, buff, PAGE_SIZE); 12862306a36Sopenharmony_ci buff += PAGE_SIZE; 12962306a36Sopenharmony_ci bytes -= PAGE_SIZE; 13062306a36Sopenharmony_ci data = squashfs_next_page(output); 13162306a36Sopenharmony_ci } 13262306a36Sopenharmony_ci squashfs_finish_page(output); 13362306a36Sopenharmony_ci 13462306a36Sopenharmony_ci return res; 13562306a36Sopenharmony_ci} 13662306a36Sopenharmony_ci 13762306a36Sopenharmony_ciconst struct squashfs_decompressor squashfs_lz4_comp_ops = { 13862306a36Sopenharmony_ci .init = lz4_init, 13962306a36Sopenharmony_ci .comp_opts = lz4_comp_opts, 14062306a36Sopenharmony_ci .free = lz4_free, 14162306a36Sopenharmony_ci .decompress = lz4_uncompress, 14262306a36Sopenharmony_ci .id = LZ4_COMPRESSION, 14362306a36Sopenharmony_ci .name = "lz4", 14462306a36Sopenharmony_ci .alloc_buffer = 0, 14562306a36Sopenharmony_ci .supported = 1 14662306a36Sopenharmony_ci}; 147