blob: 1b0baf3008ea3611bc257c7b4dd814c8645b8b02 [file] [log] [blame]
Kyungsik Leee76e1fd2013-07-08 16:01:46 -07001/*
2 * Wrapper for decompressing LZ4-compressed kernel, initramfs, and initrd
3 *
4 * Copyright (C) 2013, LG Electronics, Kyungsik Lee <kyungsik.lee@lge.com>
5 *
6 * This program is free software; you can redistribute it and/or modify
7 * it under the terms of the GNU General Public License version 2 as
8 * published by the Free Software Foundation.
9 */
10
11#ifdef STATIC
12#define PREBOOT
13#include "lz4/lz4_decompress.c"
14#else
15#include <linux/decompress/unlz4.h>
16#endif
17#include <linux/types.h>
18#include <linux/lz4.h>
19#include <linux/decompress/mm.h>
20#include <linux/compiler.h>
21
22#include <asm/unaligned.h>
23
24/*
25 * Note: Uncompressed chunk size is used in the compressor side
26 * (userspace side for compression).
27 * It is hardcoded because there is not proper way to extract it
28 * from the binary stream which is generated by the preliminary
29 * version of LZ4 tool so far.
30 */
31#define LZ4_DEFAULT_UNCOMPRESSED_CHUNK_SIZE (8 << 20)
32#define ARCHIVE_MAGICNUMBER 0x184C2102
33
Yinghai Lud97b07c2014-08-08 14:23:14 -070034STATIC inline int INIT unlz4(u8 *input, long in_len,
35 long (*fill)(void *, unsigned long),
36 long (*flush)(void *, unsigned long),
37 u8 *output, long *posp,
Kyungsik Leee76e1fd2013-07-08 16:01:46 -070038 void (*error) (char *x))
39{
40 int ret = -1;
41 size_t chunksize = 0;
42 size_t uncomp_chunksize = LZ4_DEFAULT_UNCOMPRESSED_CHUNK_SIZE;
43 u8 *inp;
44 u8 *inp_start;
45 u8 *outp;
Yinghai Lud97b07c2014-08-08 14:23:14 -070046 long size = in_len;
Kyungsik Leee76e1fd2013-07-08 16:01:46 -070047#ifdef PREBOOT
48 size_t out_len = get_unaligned_le32(input + in_len);
49#endif
50 size_t dest_len;
51
52
53 if (output) {
54 outp = output;
55 } else if (!flush) {
56 error("NULL output pointer and no flush function provided");
57 goto exit_0;
58 } else {
59 outp = large_malloc(uncomp_chunksize);
60 if (!outp) {
61 error("Could not allocate output buffer");
62 goto exit_0;
63 }
64 }
65
66 if (input && fill) {
67 error("Both input pointer and fill function provided,");
68 goto exit_1;
69 } else if (input) {
70 inp = input;
71 } else if (!fill) {
72 error("NULL input pointer and missing fill function");
73 goto exit_1;
74 } else {
Sven Schmidte23d54e2017-02-24 15:01:16 -080075 inp = large_malloc(LZ4_compressBound(uncomp_chunksize));
Kyungsik Leee76e1fd2013-07-08 16:01:46 -070076 if (!inp) {
77 error("Could not allocate input buffer");
78 goto exit_1;
79 }
80 }
81 inp_start = inp;
82
83 if (posp)
84 *posp = 0;
85
Yinghai Lu4d4b8662014-08-08 14:23:10 -070086 if (fill) {
87 size = fill(inp, 4);
88 if (size < 4) {
89 error("data corrupted");
90 goto exit_2;
91 }
92 }
Kyungsik Leee76e1fd2013-07-08 16:01:46 -070093
94 chunksize = get_unaligned_le32(inp);
95 if (chunksize == ARCHIVE_MAGICNUMBER) {
Yinghai Lu4d4b8662014-08-08 14:23:10 -070096 if (!fill) {
97 inp += 4;
98 size -= 4;
99 }
Kyungsik Leee76e1fd2013-07-08 16:01:46 -0700100 } else {
101 error("invalid header");
102 goto exit_2;
103 }
104
105 if (posp)
106 *posp += 4;
107
108 for (;;) {
109
Yinghai Lu4d4b8662014-08-08 14:23:10 -0700110 if (fill) {
111 size = fill(inp, 4);
112 if (size == 0)
113 break;
114 if (size < 4) {
115 error("data corrupted");
116 goto exit_2;
117 }
118 }
Kyungsik Leee76e1fd2013-07-08 16:01:46 -0700119
120 chunksize = get_unaligned_le32(inp);
121 if (chunksize == ARCHIVE_MAGICNUMBER) {
Yinghai Lu4d4b8662014-08-08 14:23:10 -0700122 if (!fill) {
123 inp += 4;
124 size -= 4;
125 }
Kyungsik Leee76e1fd2013-07-08 16:01:46 -0700126 if (posp)
127 *posp += 4;
128 continue;
129 }
Yinghai Lu4d4b8662014-08-08 14:23:10 -0700130
Kyungsik Leee76e1fd2013-07-08 16:01:46 -0700131
132 if (posp)
133 *posp += 4;
134
Yinghai Lu4d4b8662014-08-08 14:23:10 -0700135 if (!fill) {
136 inp += 4;
137 size -= 4;
138 } else {
Sven Schmidte23d54e2017-02-24 15:01:16 -0800139 if (chunksize > LZ4_compressBound(uncomp_chunksize)) {
Kyungsik Leee76e1fd2013-07-08 16:01:46 -0700140 error("chunk length is longer than allocated");
141 goto exit_2;
142 }
Yinghai Lu4d4b8662014-08-08 14:23:10 -0700143 size = fill(inp, chunksize);
144 if (size < chunksize) {
145 error("data corrupted");
146 goto exit_2;
147 }
Kyungsik Leee76e1fd2013-07-08 16:01:46 -0700148 }
149#ifdef PREBOOT
150 if (out_len >= uncomp_chunksize) {
151 dest_len = uncomp_chunksize;
152 out_len -= dest_len;
153 } else
154 dest_len = out_len;
Sven Schmidte23d54e2017-02-24 15:01:16 -0800155
156 ret = LZ4_decompress_fast(inp, outp, dest_len);
157 chunksize = ret;
Kyungsik Leee76e1fd2013-07-08 16:01:46 -0700158#else
159 dest_len = uncomp_chunksize;
Sven Schmidte23d54e2017-02-24 15:01:16 -0800160
161 ret = LZ4_decompress_safe(inp, outp, chunksize, dest_len);
162 dest_len = ret;
Kyungsik Leee76e1fd2013-07-08 16:01:46 -0700163#endif
164 if (ret < 0) {
165 error("Decoding failed");
166 goto exit_2;
167 }
168
Jan Beulich2a1d6892014-01-23 15:56:20 -0800169 ret = -1;
Kyungsik Leee76e1fd2013-07-08 16:01:46 -0700170 if (flush && flush(outp, dest_len) != dest_len)
171 goto exit_2;
172 if (output)
173 outp += dest_len;
174 if (posp)
175 *posp += chunksize;
176
Yinghai Lu4d4b8662014-08-08 14:23:10 -0700177 if (!fill) {
178 size -= chunksize;
Kyungsik Leee76e1fd2013-07-08 16:01:46 -0700179
Yinghai Lu4d4b8662014-08-08 14:23:10 -0700180 if (size == 0)
181 break;
182 else if (size < 0) {
183 error("data corrupted");
184 goto exit_2;
185 }
186 inp += chunksize;
Kyungsik Leee76e1fd2013-07-08 16:01:46 -0700187 }
Kyungsik Leee76e1fd2013-07-08 16:01:46 -0700188 }
189
190 ret = 0;
191exit_2:
192 if (!input)
193 large_free(inp_start);
194exit_1:
195 if (!output)
196 large_free(outp);
197exit_0:
198 return ret;
199}
200
201#ifdef PREBOOT
Yinghai Lu2d3862d2015-09-09 15:39:12 -0700202STATIC int INIT __decompress(unsigned char *buf, long in_len,
Yinghai Lud97b07c2014-08-08 14:23:14 -0700203 long (*fill)(void*, unsigned long),
204 long (*flush)(void*, unsigned long),
Yinghai Lu2d3862d2015-09-09 15:39:12 -0700205 unsigned char *output, long out_len,
Yinghai Lud97b07c2014-08-08 14:23:14 -0700206 long *posp,
Yinghai Lu2d3862d2015-09-09 15:39:12 -0700207 void (*error)(char *x)
Kyungsik Leee76e1fd2013-07-08 16:01:46 -0700208 )
209{
210 return unlz4(buf, in_len - 4, fill, flush, output, posp, error);
211}
212#endif