Tom Rini | 8b0c8a1 | 2018-05-06 18:27:01 -0400 | [diff] [blame] | 1 | // SPDX-License-Identifier: GPL 2.0+ OR BSD-3-Clause |
Julius Werner | f41a3ca | 2015-10-06 20:03:53 -0700 | [diff] [blame] | 2 | /* |
| 3 | * Copyright 2015 Google Inc. |
Julius Werner | f41a3ca | 2015-10-06 20:03:53 -0700 | [diff] [blame] | 4 | */ |
| 5 | |
Julius Werner | f41a3ca | 2015-10-06 20:03:53 -0700 | [diff] [blame] | 6 | #include <compiler.h> |
Eugeniu Rosca | 1403f39 | 2019-04-08 17:35:27 +0200 | [diff] [blame] | 7 | #include <image.h> |
Julius Werner | f41a3ca | 2015-10-06 20:03:53 -0700 | [diff] [blame] | 8 | #include <linux/kernel.h> |
| 9 | #include <linux/types.h> |
Rasmus Villemoes | 1849639 | 2020-06-07 14:29:18 +0200 | [diff] [blame] | 10 | #include <asm/unaligned.h> |
Simon Glass | caf6267 | 2021-10-09 09:28:21 -0600 | [diff] [blame] | 11 | #include <u-boot/lz4.h> |
Julius Werner | f41a3ca | 2015-10-06 20:03:53 -0700 | [diff] [blame] | 12 | |
Rasmus Villemoes | 1849639 | 2020-06-07 14:29:18 +0200 | [diff] [blame] | 13 | /* lz4.c is unaltered (except removing unrelated code) from github.com/Cyan4973/lz4. */ |
Julius Werner | f41a3ca | 2015-10-06 20:03:53 -0700 | [diff] [blame] | 14 | #include "lz4.c" /* #include for inlining, do not link! */ |
| 15 | |
Rasmus Villemoes | 1849639 | 2020-06-07 14:29:18 +0200 | [diff] [blame] | 16 | #define LZ4F_BLOCKUNCOMPRESSED_FLAG 0x80000000U |
Julius Werner | f41a3ca | 2015-10-06 20:03:53 -0700 | [diff] [blame] | 17 | |
| 18 | int ulz4fn(const void *src, size_t srcn, void *dst, size_t *dstn) |
| 19 | { |
| 20 | const void *end = dst + *dstn; |
| 21 | const void *in = src; |
| 22 | void *out = dst; |
| 23 | int has_block_checksum; |
| 24 | int ret; |
| 25 | *dstn = 0; |
| 26 | |
| 27 | { /* With in-place decompression the header may become invalid later. */ |
Rasmus Villemoes | 1849639 | 2020-06-07 14:29:18 +0200 | [diff] [blame] | 28 | u32 magic; |
| 29 | u8 flags, version, independent_blocks, has_content_size; |
| 30 | u8 block_desc; |
Julius Werner | f41a3ca | 2015-10-06 20:03:53 -0700 | [diff] [blame] | 31 | |
Rasmus Villemoes | 1849639 | 2020-06-07 14:29:18 +0200 | [diff] [blame] | 32 | if (srcn < sizeof(u32) + 3*sizeof(u8)) |
Julius Werner | f41a3ca | 2015-10-06 20:03:53 -0700 | [diff] [blame] | 33 | return -EINVAL; /* input overrun */ |
| 34 | |
Rasmus Villemoes | 1849639 | 2020-06-07 14:29:18 +0200 | [diff] [blame] | 35 | magic = get_unaligned_le32(in); |
| 36 | in += sizeof(u32); |
| 37 | flags = *(u8 *)in; |
| 38 | in += sizeof(u8); |
| 39 | block_desc = *(u8 *)in; |
| 40 | in += sizeof(u8); |
| 41 | |
| 42 | version = (flags >> 6) & 0x3; |
| 43 | independent_blocks = (flags >> 5) & 0x1; |
| 44 | has_block_checksum = (flags >> 4) & 0x1; |
| 45 | has_content_size = (flags >> 3) & 0x1; |
| 46 | |
Julius Werner | f41a3ca | 2015-10-06 20:03:53 -0700 | [diff] [blame] | 47 | /* We assume there's always only a single, standard frame. */ |
Rasmus Villemoes | 1849639 | 2020-06-07 14:29:18 +0200 | [diff] [blame] | 48 | if (magic != LZ4F_MAGIC || version != 1) |
Julius Werner | f41a3ca | 2015-10-06 20:03:53 -0700 | [diff] [blame] | 49 | return -EPROTONOSUPPORT; /* unknown format */ |
Rasmus Villemoes | 1849639 | 2020-06-07 14:29:18 +0200 | [diff] [blame] | 50 | if ((flags & 0x03) || (block_desc & 0x8f)) |
| 51 | return -EINVAL; /* reserved bits must be zero */ |
| 52 | if (!independent_blocks) |
Julius Werner | f41a3ca | 2015-10-06 20:03:53 -0700 | [diff] [blame] | 53 | return -EPROTONOSUPPORT; /* we can't support this yet */ |
Julius Werner | f41a3ca | 2015-10-06 20:03:53 -0700 | [diff] [blame] | 54 | |
Rasmus Villemoes | 1849639 | 2020-06-07 14:29:18 +0200 | [diff] [blame] | 55 | if (has_content_size) { |
| 56 | if (srcn < sizeof(u32) + 3*sizeof(u8) + sizeof(u64)) |
| 57 | return -EINVAL; /* input overrun */ |
Julius Werner | f41a3ca | 2015-10-06 20:03:53 -0700 | [diff] [blame] | 58 | in += sizeof(u64); |
Rasmus Villemoes | 1849639 | 2020-06-07 14:29:18 +0200 | [diff] [blame] | 59 | } |
| 60 | /* Header checksum byte */ |
Julius Werner | f41a3ca | 2015-10-06 20:03:53 -0700 | [diff] [blame] | 61 | in += sizeof(u8); |
| 62 | } |
| 63 | |
| 64 | while (1) { |
Rasmus Villemoes | 1849639 | 2020-06-07 14:29:18 +0200 | [diff] [blame] | 65 | u32 block_header, block_size; |
Stephen Warren | bf562fd | 2015-11-14 23:53:49 -0700 | [diff] [blame] | 66 | |
Rasmus Villemoes | 1849639 | 2020-06-07 14:29:18 +0200 | [diff] [blame] | 67 | block_header = get_unaligned_le32(in); |
| 68 | in += sizeof(u32); |
| 69 | block_size = block_header & ~LZ4F_BLOCKUNCOMPRESSED_FLAG; |
Julius Werner | f41a3ca | 2015-10-06 20:03:53 -0700 | [diff] [blame] | 70 | |
Rasmus Villemoes | 1849639 | 2020-06-07 14:29:18 +0200 | [diff] [blame] | 71 | if (in - src + block_size > srcn) { |
Julius Werner | f41a3ca | 2015-10-06 20:03:53 -0700 | [diff] [blame] | 72 | ret = -EINVAL; /* input overrun */ |
| 73 | break; |
| 74 | } |
| 75 | |
Rasmus Villemoes | 1849639 | 2020-06-07 14:29:18 +0200 | [diff] [blame] | 76 | if (!block_size) { |
Julius Werner | f41a3ca | 2015-10-06 20:03:53 -0700 | [diff] [blame] | 77 | ret = 0; /* decompression successful */ |
| 78 | break; |
| 79 | } |
| 80 | |
Rasmus Villemoes | 1849639 | 2020-06-07 14:29:18 +0200 | [diff] [blame] | 81 | if (block_header & LZ4F_BLOCKUNCOMPRESSED_FLAG) { |
Pali Rohár | 57da44c | 2022-07-27 17:24:23 +0200 | [diff] [blame] | 82 | size_t size = min((ptrdiff_t)block_size, (ptrdiff_t)(end - out)); |
Julius Werner | f41a3ca | 2015-10-06 20:03:53 -0700 | [diff] [blame] | 83 | memcpy(out, in, size); |
| 84 | out += size; |
Rasmus Villemoes | 1849639 | 2020-06-07 14:29:18 +0200 | [diff] [blame] | 85 | if (size < block_size) { |
Julius Werner | f41a3ca | 2015-10-06 20:03:53 -0700 | [diff] [blame] | 86 | ret = -ENOBUFS; /* output overrun */ |
| 87 | break; |
| 88 | } |
| 89 | } else { |
| 90 | /* constant folding essential, do not touch params! */ |
Rasmus Villemoes | 1849639 | 2020-06-07 14:29:18 +0200 | [diff] [blame] | 91 | ret = LZ4_decompress_generic(in, out, block_size, |
Julius Werner | f41a3ca | 2015-10-06 20:03:53 -0700 | [diff] [blame] | 92 | end - out, endOnInputSize, |
Huang Jianan | 24a0c50 | 2022-02-26 15:05:48 +0800 | [diff] [blame] | 93 | decode_full_block, noDict, out, NULL, 0); |
Julius Werner | f41a3ca | 2015-10-06 20:03:53 -0700 | [diff] [blame] | 94 | if (ret < 0) { |
| 95 | ret = -EPROTO; /* decompression error */ |
| 96 | break; |
| 97 | } |
| 98 | out += ret; |
| 99 | } |
| 100 | |
Rasmus Villemoes | 1849639 | 2020-06-07 14:29:18 +0200 | [diff] [blame] | 101 | in += block_size; |
Julius Werner | f41a3ca | 2015-10-06 20:03:53 -0700 | [diff] [blame] | 102 | if (has_block_checksum) |
| 103 | in += sizeof(u32); |
| 104 | } |
| 105 | |
| 106 | *dstn = out - dst; |
| 107 | return ret; |
| 108 | } |