1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20#include <config.h>
21#include <common.h>
22#include <log.h>
23#include <watchdog.h>
24
25#ifdef CONFIG_LZMA
26
27#define LZMA_PROPERTIES_OFFSET 0
28#define LZMA_SIZE_OFFSET LZMA_PROPS_SIZE
29#define LZMA_DATA_OFFSET LZMA_SIZE_OFFSET+sizeof(uint64_t)
30
31#include "LzmaTools.h"
32#include "LzmaDec.h"
33
34#include <linux/string.h>
35#include <malloc.h>
36
37static void *SzAlloc(void *p, size_t size) { return malloc(size); }
38static void SzFree(void *p, void *address) { free(address); }
39
40int lzmaBuffToBuffDecompress (unsigned char *outStream, SizeT *uncompressedSize,
41 unsigned char *inStream, SizeT length)
42{
43 int res = SZ_ERROR_DATA;
44 int i;
45 ISzAlloc g_Alloc;
46
47 SizeT outSizeFull = 0xFFFFFFFF;
48 SizeT outProcessed;
49 SizeT outSize;
50 SizeT outSizeHigh;
51 ELzmaStatus state;
52 SizeT compressedSize = (SizeT)(length - LZMA_PROPS_SIZE);
53
54 debug ("LZMA: Image address............... 0x%p\n", inStream);
55 debug ("LZMA: Properties address.......... 0x%p\n", inStream + LZMA_PROPERTIES_OFFSET);
56 debug ("LZMA: Uncompressed size address... 0x%p\n", inStream + LZMA_SIZE_OFFSET);
57 debug ("LZMA: Compressed data address..... 0x%p\n", inStream + LZMA_DATA_OFFSET);
58 debug ("LZMA: Destination address......... 0x%p\n", outStream);
59
60 memset(&state, 0, sizeof(state));
61
62 outSize = 0;
63 outSizeHigh = 0;
64
65 for (i = 0; i < 8; i++) {
66 unsigned char b = inStream[LZMA_SIZE_OFFSET + i];
67 if (i < 4) {
68 outSize += (UInt32)(b) << (i * 8);
69 } else {
70 outSizeHigh += (UInt32)(b) << ((i - 4) * 8);
71 }
72 }
73
74 outSizeFull = (SizeT)outSize;
75 if (sizeof(SizeT) >= 8) {
76
77
78
79
80 outSizeFull |= (((SizeT)outSizeHigh << 16) << 16);
81 } else if (outSizeHigh != 0 || (UInt32)(SizeT)outSize != outSize) {
82
83
84
85
86
87
88 if (outSizeHigh != (SizeT)-1 || outSize != (SizeT)-1) {
89 debug ("LZMA: 64bit support not enabled.\n");
90 return SZ_ERROR_DATA;
91 }
92 }
93
94 debug("LZMA: Uncompresed size............ 0x%zx\n", outSizeFull);
95 debug("LZMA: Compresed size.............. 0x%zx\n", compressedSize);
96
97 g_Alloc.Alloc = SzAlloc;
98 g_Alloc.Free = SzFree;
99
100
101 if (outSizeFull != (SizeT)-1 && *uncompressedSize < outSizeFull)
102 return SZ_ERROR_OUTPUT_EOF;
103
104
105 outProcessed = min(outSizeFull, *uncompressedSize);
106
107 WATCHDOG_RESET();
108
109 res = LzmaDecode(
110 outStream, &outProcessed,
111 inStream + LZMA_DATA_OFFSET, &compressedSize,
112 inStream, LZMA_PROPS_SIZE, LZMA_FINISH_END, &state, &g_Alloc);
113 *uncompressedSize = outProcessed;
114
115 debug("LZMA: Uncompressed ............... 0x%zx\n", outProcessed);
116
117 if (res != SZ_OK) {
118 return res;
119 }
120
121 return res;
122}
123
124#endif
125