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