]> git.sur5r.net Git - u-boot/blob - lib/gunzip.c
spi: zynqmp_gqspi: Add support for ZynqMP qspi driver
[u-boot] / lib / gunzip.c
1 // SPDX-License-Identifier: GPL-2.0+
2 /*
3  * (C) Copyright 2000-2006
4  * Wolfgang Denk, DENX Software Engineering, wd@denx.de.
5  */
6
7 #include <common.h>
8 #include <watchdog.h>
9 #include <command.h>
10 #include <console.h>
11 #include <image.h>
12 #include <malloc.h>
13 #include <memalign.h>
14 #include <u-boot/zlib.h>
15 #include <div64.h>
16
17 #define HEADER0                 '\x1f'
18 #define HEADER1                 '\x8b'
19 #define ZALLOC_ALIGNMENT        16
20 #define HEAD_CRC                2
21 #define EXTRA_FIELD             4
22 #define ORIG_NAME               8
23 #define COMMENT                 0x10
24 #define RESERVED                0xe0
25 #define DEFLATED                8
26
27 void *gzalloc(void *x, unsigned items, unsigned size)
28 {
29         void *p;
30
31         size *= items;
32         size = (size + ZALLOC_ALIGNMENT - 1) & ~(ZALLOC_ALIGNMENT - 1);
33
34         p = malloc (size);
35
36         return (p);
37 }
38
39 void gzfree(void *x, void *addr, unsigned nb)
40 {
41         free (addr);
42 }
43
44 int gzip_parse_header(const unsigned char *src, unsigned long len)
45 {
46         int i, flags;
47
48         /* skip header */
49         i = 10;
50         flags = src[3];
51         if (src[2] != DEFLATED || (flags & RESERVED) != 0) {
52                 puts ("Error: Bad gzipped data\n");
53                 return (-1);
54         }
55         if ((flags & EXTRA_FIELD) != 0)
56                 i = 12 + src[10] + (src[11] << 8);
57         if ((flags & ORIG_NAME) != 0)
58                 while (src[i++] != 0)
59                         ;
60         if ((flags & COMMENT) != 0)
61                 while (src[i++] != 0)
62                         ;
63         if ((flags & HEAD_CRC) != 0)
64                 i += 2;
65         if (i >= len) {
66                 puts ("Error: gunzip out of data in header\n");
67                 return (-1);
68         }
69         return i;
70 }
71
72 int gunzip(void *dst, int dstlen, unsigned char *src, unsigned long *lenp)
73 {
74         int offset = gzip_parse_header(src, *lenp);
75
76         if (offset < 0)
77                 return offset;
78
79         return zunzip(dst, dstlen, src, lenp, 1, offset);
80 }
81
82 #ifdef CONFIG_CMD_UNZIP
83 __weak
84 void gzwrite_progress_init(u64 expectedsize)
85 {
86         putc('\n');
87 }
88
89 __weak
90 void gzwrite_progress(int iteration,
91                      u64 bytes_written,
92                      u64 total_bytes)
93 {
94         if (0 == (iteration & 3))
95                 printf("%llu/%llu\r", bytes_written, total_bytes);
96 }
97
98 __weak
99 void gzwrite_progress_finish(int returnval,
100                              u64 bytes_written,
101                              u64 total_bytes,
102                              u32 expected_crc,
103                              u32 calculated_crc)
104 {
105         if (0 == returnval) {
106                 printf("\n\t%llu bytes, crc 0x%08x\n",
107                        total_bytes, calculated_crc);
108         } else {
109                 printf("\n\tuncompressed %llu of %llu\n"
110                        "\tcrcs == 0x%08x/0x%08x\n",
111                        bytes_written, total_bytes,
112                        expected_crc, calculated_crc);
113         }
114 }
115
116 int gzwrite(unsigned char *src, int len,
117             struct blk_desc *dev,
118             unsigned long szwritebuf,
119             u64 startoffs,
120             u64 szexpected)
121 {
122         int i, flags;
123         z_stream s;
124         int r = 0;
125         unsigned char *writebuf;
126         unsigned crc = 0;
127         u64 totalfilled = 0;
128         lbaint_t blksperbuf, outblock;
129         u32 expected_crc;
130         u32 payload_size;
131         int iteration = 0;
132
133         if (!szwritebuf ||
134             (szwritebuf % dev->blksz) ||
135             (szwritebuf < dev->blksz)) {
136                 printf("%s: size %lu not a multiple of %lu\n",
137                        __func__, szwritebuf, dev->blksz);
138                 return -1;
139         }
140
141         if (startoffs & (dev->blksz-1)) {
142                 printf("%s: start offset %llu not a multiple of %lu\n",
143                        __func__, startoffs, dev->blksz);
144                 return -1;
145         }
146
147         blksperbuf = szwritebuf / dev->blksz;
148         outblock = lldiv(startoffs, dev->blksz);
149
150         /* skip header */
151         i = 10;
152         flags = src[3];
153         if (src[2] != DEFLATED || (flags & RESERVED) != 0) {
154                 puts("Error: Bad gzipped data\n");
155                 return -1;
156         }
157         if ((flags & EXTRA_FIELD) != 0)
158                 i = 12 + src[10] + (src[11] << 8);
159         if ((flags & ORIG_NAME) != 0)
160                 while (src[i++] != 0)
161                         ;
162         if ((flags & COMMENT) != 0)
163                 while (src[i++] != 0)
164                         ;
165         if ((flags & HEAD_CRC) != 0)
166                 i += 2;
167
168         if (i >= len-8) {
169                 puts("Error: gunzip out of data in header");
170                 return -1;
171         }
172
173         payload_size = len - i - 8;
174
175         memcpy(&expected_crc, src + len - 8, sizeof(expected_crc));
176         expected_crc = le32_to_cpu(expected_crc);
177         u32 szuncompressed;
178         memcpy(&szuncompressed, src + len - 4, sizeof(szuncompressed));
179         if (szexpected == 0) {
180                 szexpected = le32_to_cpu(szuncompressed);
181         } else if (szuncompressed != (u32)szexpected) {
182                 printf("size of %llx doesn't match trailer low bits %x\n",
183                        szexpected, szuncompressed);
184                 return -1;
185         }
186         if (lldiv(szexpected, dev->blksz) > (dev->lba - outblock)) {
187                 printf("%s: uncompressed size %llu exceeds device size\n",
188                        __func__, szexpected);
189                 return -1;
190         }
191
192         gzwrite_progress_init(szexpected);
193
194         s.zalloc = gzalloc;
195         s.zfree = gzfree;
196
197         r = inflateInit2(&s, -MAX_WBITS);
198         if (r != Z_OK) {
199                 printf("Error: inflateInit2() returned %d\n", r);
200                 return -1;
201         }
202
203         s.next_in = src + i;
204         s.avail_in = payload_size+8;
205         writebuf = (unsigned char *)malloc_cache_aligned(szwritebuf);
206
207         /* decompress until deflate stream ends or end of file */
208         do {
209                 if (s.avail_in == 0) {
210                         printf("%s: weird termination with result %d\n",
211                                __func__, r);
212                         break;
213                 }
214
215                 /* run inflate() on input until output buffer not full */
216                 do {
217                         unsigned long blocks_written;
218                         int numfilled;
219                         lbaint_t writeblocks;
220
221                         s.avail_out = szwritebuf;
222                         s.next_out = writebuf;
223                         r = inflate(&s, Z_SYNC_FLUSH);
224                         if ((r != Z_OK) &&
225                             (r != Z_STREAM_END)) {
226                                 printf("Error: inflate() returned %d\n", r);
227                                 goto out;
228                         }
229                         numfilled = szwritebuf - s.avail_out;
230                         crc = crc32(crc, writebuf, numfilled);
231                         totalfilled += numfilled;
232                         if (numfilled < szwritebuf) {
233                                 writeblocks = (numfilled+dev->blksz-1)
234                                                 / dev->blksz;
235                                 memset(writebuf+numfilled, 0,
236                                        dev->blksz-(numfilled%dev->blksz));
237                         } else {
238                                 writeblocks = blksperbuf;
239                         }
240
241                         gzwrite_progress(iteration++,
242                                          totalfilled,
243                                          szexpected);
244                         blocks_written = blk_dwrite(dev, outblock,
245                                                     writeblocks, writebuf);
246                         outblock += blocks_written;
247                         if (ctrlc()) {
248                                 puts("abort\n");
249                                 goto out;
250                         }
251                         WATCHDOG_RESET();
252                 } while (s.avail_out == 0);
253                 /* done when inflate() says it's done */
254         } while (r != Z_STREAM_END);
255
256         if ((szexpected != totalfilled) ||
257             (crc != expected_crc))
258                 r = -1;
259         else
260                 r = 0;
261
262 out:
263         gzwrite_progress_finish(r, totalfilled, szexpected,
264                                 expected_crc, crc);
265         free(writebuf);
266         inflateEnd(&s);
267
268         return r;
269 }
270 #endif
271
272 /*
273  * Uncompress blocks compressed with zlib without headers
274  */
275 int zunzip(void *dst, int dstlen, unsigned char *src, unsigned long *lenp,
276                                                 int stoponerr, int offset)
277 {
278         z_stream s;
279         int err = 0;
280         int r;
281
282         s.zalloc = gzalloc;
283         s.zfree = gzfree;
284
285         r = inflateInit2(&s, -MAX_WBITS);
286         if (r != Z_OK) {
287                 printf("Error: inflateInit2() returned %d\n", r);
288                 return -1;
289         }
290         s.next_in = src + offset;
291         s.avail_in = *lenp - offset;
292         s.next_out = dst;
293         s.avail_out = dstlen;
294         do {
295                 r = inflate(&s, Z_FINISH);
296                 if (stoponerr == 1 && r != Z_STREAM_END &&
297                     (s.avail_in == 0 || s.avail_out == 0 || r != Z_BUF_ERROR)) {
298                         printf("Error: inflate() returned %d\n", r);
299                         err = -1;
300                         break;
301                 }
302         } while (r == Z_BUF_ERROR);
303         *lenp = s.next_out - (unsigned char *) dst;
304         inflateEnd(&s);
305
306         return err;
307 }