]>
Commit | Line | Data |
---|---|---|
e433bc03 MG |
1 | #include <sys/stat.h> |
2 | #include <sys/types.h> | |
3 | #include <limits.h> | |
4 | #include <fcntl.h> | |
90836933 | 5 | #include <stdio.h> |
14ff7444 MG |
6 | #include <stdlib.h> |
7 | #include <strings.h> | |
8 | #include <string.h> | |
e433bc03 | 9 | #include <unistd.h> |
14ff7444 | 10 | #include <errno.h> |
e433bc03 | 11 | #include <libgen.h> |
af1fed3a | 12 | #include "rsb-crc.h" |
90836933 MG |
13 | #include "rsb-lz.h" |
14 | ||
650ebf3b MG |
15 | /* TODO: IMPLEMET THIS! */ |
16 | /* Probably very broken lzw implementation by Agilent: | |
17 | * | |
5d56af72 MG |
18 | * 59508: e3a00078 mov r0, #120 ; 0x78 |
19 | * 5950c: ee010f10 mcr 15, 0, r0, cr1, cr0, {0} | |
20 | * 59510: e3a00000 mov r0, #0 ; 0x0 | |
21 | * 59514: ee070f15 mcr 15, 0, r0, cr7, cr5, {0} | |
22 | * 59518: ee070f16 mcr 15, 0, r0, cr7, cr6, {0} | |
23 | * 5951c: ee020f30 mcr 15, 0, r0, cr2, cr0, {1} | |
24 | * 59520: ee020f10 mcr 15, 0, r0, cr2, cr0, {0} | |
25 | * 59524: ee030f10 mcr 15, 0, r0, cr3, cr0, {0} | |
26 | * 59528: ee050f70 mcr 15, 0, r0, cr5, cr0, {3} | |
27 | * 5952c: ee050f50 mcr 15, 0, r0, cr5, cr0, {2} | |
28 | * 59530: ee050f30 mcr 15, 0, r0, cr5, cr0, {1} | |
29 | * 59534: ee050f10 mcr 15, 0, r0, cr5, cr0, {0} | |
30 | * 59538: e3a00016 mov r0, #22 ; 0x16 | |
31 | * 5953c: ee060f10 mcr 15, 0, r0, cr6, cr0, {0} | |
32 | * 59540: ee060f11 mcr 15, 0, r0, cr6, cr1, {0} | |
33 | * 59544: ee060f12 mcr 15, 0, r0, cr6, cr2, {0} | |
34 | * 59548: ee060f13 mcr 15, 0, r0, cr6, cr3, {0} | |
35 | * 5954c: ee060f14 mcr 15, 0, r0, cr6, cr4, {0} | |
36 | * 59550: ee060f15 mcr 15, 0, r0, cr6, cr5, {0} | |
37 | * 59554: ee060f16 mcr 15, 0, r0, cr6, cr6, {0} | |
38 | * 59558: ee060f17 mcr 15, 0, r0, cr6, cr7, {0} | |
39 | * 5955c: e1a0f00e mov r15, r14 | |
40 | * 59560: e3a01000 mov r1, #0 ; 0x0 | |
41 | * 59564: ee071f15 mcr 15, 0, r1, cr7, cr5, {0} | |
42 | * 59568: ee071f16 mcr 15, 0, r1, cr7, cr6, {0} | |
43 | * 5956c: e3800078 orr r0, r0, #120 ; 0x78 | |
44 | * 59570: ee010f10 mcr 15, 0, r0, cr1, cr0, {0} | |
45 | * 59574: e1a0f00e mov r15, r14 | |
46 | * 59578: e92d00f0 push {r4, r5, r6, r7} | |
47 | * 5957c: e3500007 cmp r0, #7 ; 0x7 | |
48 | * 59580: 8a00003c bhi 0x59678 | |
49 | * 59584: e3e04ef0 mvn r4, #3840 ; 0xf00 | |
50 | * 59588: e22440ff eor r4, r4, #255 ; 0xff | |
51 | * 5958c: e1d14004 bics r4, r1, r4 | |
52 | * 59590: 1a000038 bne 0x59678 | |
53 | * 59594: e3a0403f mov r4, #63 ; 0x3f | |
54 | * 59598: e1d24004 bics r4, r2, r4 | |
55 | * 5959c: 1a000035 bne 0x59678 | |
56 | * 595a0: e3a06001 mov r6, #1 ; 0x1 | |
57 | * 595a4: e1a04423 lsr r4, r3, #8 | |
58 | * 595a8: e2044001 and r4, r4, #1 ; 0x1 | |
59 | * 595ac: ee125f30 mrc 15, 0, r5, cr2, cr0, {1} | |
60 | * 595b0: e1c55016 bic r5, r5, r6, lsl r0 | |
61 | * 595b4: e1855014 orr r5, r5, r4, lsl r0 | |
62 | * 595b8: ee025f30 mcr 15, 0, r5, cr2, cr0, {1} | |
63 | * 595bc: e1a044a3 lsr r4, r3, #9 | |
64 | * 595c0: e2044001 and r4, r4, #1 ; 0x1 | |
65 | * 595c4: ee125f10 mrc 15, 0, r5, cr2, cr0, {0} | |
66 | * 595c8: e1c55016 bic r5, r5, r6, lsl r0 | |
67 | * 595cc: e1855014 orr r5, r5, r4, lsl r0 | |
68 | * 595d0: ee025f10 mcr 15, 0, r5, cr2, cr0, {0} | |
69 | * 595d4: e1a04523 lsr r4, r3, #10 | |
70 | * 595d8: e2044001 and r4, r4, #1 ; 0x1 | |
71 | * 595dc: ee135f10 mrc 15, 0, r5, cr3, cr0, {0} | |
72 | * 595e0: e1c55016 bic r5, r5, r6, lsl r0 | |
73 | * 595e4: e1855014 orr r5, r5, r4, lsl r0 | |
74 | * 595e8: ee035f10 mcr 15, 0, r5, cr3, cr0, {0} | |
75 | * 595ec: e3a0600f mov r6, #15 ; 0xf | |
76 | * 595f0: e3a07004 mov r7, #4 ; 0x4 | |
77 | * 595f4: e0070790 mul r7, r0, r7 | |
78 | * 595f8: e0034006 and r4, r3, r6 | |
79 | * 595fc: ee155f70 mrc 15, 0, r5, cr5, cr0, {3} | |
80 | * 59600: e1c55716 bic r5, r5, r6, lsl r7 | |
81 | * 59604: e1855714 orr r5, r5, r4, lsl r7 | |
82 | * 59608: ee055f70 mcr 15, 0, r5, cr5, cr0, {3} | |
83 | * 5960c: e1a04223 lsr r4, r3, #4 | |
84 | * 59610: e0044006 and r4, r4, r6 | |
85 | * 59614: ee155f50 mrc 15, 0, r5, cr5, cr0, {2} | |
86 | * 59618: e1c55716 bic r5, r5, r6, lsl r7 | |
87 | * 5961c: e1855714 orr r5, r5, r4, lsl r7 | |
88 | * 59620: ee055f50 mcr 15, 0, r5, cr5, cr0, {2} | |
89 | * 59624: e1814002 orr r4, r1, r2 | |
90 | * 59628: e08ff180 add r15, r15, r0, lsl #3 | |
91 | * 5962c: e1a00000 nop (mov r0,r0) | |
92 | * 59630: ee064f10 mcr 15, 0, r4, cr6, cr0, {0} | |
93 | * 59634: ea00000c b 0x5966c | |
94 | * 59638: ee064f11 mcr 15, 0, r4, cr6, cr1, {0} | |
95 | * 5963c: ea00000a b 0x5966c | |
96 | * 59640: ee064f12 mcr 15, 0, r4, cr6, cr2, {0} | |
97 | * 59644: ea000008 b 0x5966c | |
98 | * 59648: ee064f13 mcr 15, 0, r4, cr6, cr3, {0} | |
99 | * 5964c: ea000006 b 0x5966c | |
100 | * 59650: ee064f14 mcr 15, 0, r4, cr6, cr4, {0} | |
101 | * 59654: ea000004 b 0x5966c | |
102 | * 59658: ee064f15 mcr 15, 0, r4, cr6, cr5, {0} | |
103 | * 5965c: ea000002 b 0x5966c | |
104 | * 59660: ee064f16 mcr 15, 0, r4, cr6, cr6, {0} | |
105 | * 59664: ea000000 b 0x5966c | |
106 | * 59668: ee064f17 mcr 15, 0, r4, cr6, cr7, {0} | |
107 | * 5966c: e3a00000 mov r0, #0 ; 0x0 | |
108 | * 59670: e8bd00f0 pop {r4, r5, r6, r7} | |
109 | * 59674: e1a0f00e mov r15, r14 | |
110 | * 59678: e3e00000 mvn r0, #0 ; 0x0 | |
111 | * 5967c: e8bd00f0 pop {r4, r5, r6, r7} | |
112 | * 59680: e1a0f00e mov r15, r14 | |
0fcfb8f3 MG |
113 | * 59684: e92d43f8 push {r3, r4, r5, r6, r7, r8, r9, r14} |
114 | * 59688: eb000000 bl 0x59690 | |
115 | * 5968c: e8bd83f8 pop {r3, r4, r5, r6, r7, r8, r9, r15} | |
116 | * 59690: e3a08001 mov r8, #1 ; 0x1 | |
117 | * 59694: e3a034c0 mov r3, #-1073741824 ; 0xc0000000 | |
118 | * 59698: e1500003 cmp r0, r3 | |
119 | * 5969c: da000022 ble 0x5972c | |
120 | * 596a0: e3a03020 mov r3, #32 ; 0x20 | |
121 | * 596a4: e7b34000 ldr r4, [r3, r0]! | |
122 | * 596a8: e3a08002 mov r8, #2 ; 0x2 | |
123 | * 596ac: e5935004 ldr r5, [r3, #4] | |
124 | * 596b0: e1550002 cmp r5, r2 | |
125 | * 596b4: 1a00001c bne 0x5972c | |
126 | * 596b8: e3a08003 mov r8, #3 ; 0x3 | |
127 | * 596bc: e1510004 cmp r1, r4 | |
128 | * 596c0: 23b05000 movscs r5, #0 ; 0x0 | |
129 | * 596c4: 33b05001 movscc r5, #1 ; 0x1 | |
130 | * 596c8: 1a000017 bne 0x5972c | |
131 | * 596cc: e3a08004 mov r8, #4 ; 0x4 | |
132 | * 596d0: e1a03000 mov r3, r0 | |
133 | * 596d4: e0804004 add r4, r0, r4 | |
134 | * 596d8: e3e05000 mvn r5, #0 ; 0x0 | |
135 | * 596dc: e59f7050 ldr r7, [pc, #80] ; 0x59734 | |
136 | * 596e0: e1530004 cmp r3, r4 | |
137 | * 596e4: 2a00000c bcs 0x5971c | |
138 | * 596e8: e3c39003 bic r9, r3, #3 ; 0x3 | |
139 | * 596ec: e5996000 ldr r6, [r9] | |
140 | * 596f0: e2039003 and r9, r3, #3 ; 0x3 | |
141 | * 596f4: e1a09189 lsl r9, r9, #3 | |
142 | * 596f8: e1a06936 lsr r6, r6, r9 | |
143 | * 596fc: e0255c06 eor r5, r5, r6, lsl #24 | |
144 | * 59700: e3a06008 mov r6, #8 ; 0x8 | |
145 | * 59704: e1b05085 lsls r5, r5, #1 | |
146 | * 59708: 20255007 eorcs r5, r5, r7 | |
147 | * 5970c: e2566001 subs r6, r6, #1 ; 0x1 | |
148 | * 59710: 1afffffb bne 0x59704 | |
149 | * 59714: e2833001 add r3, r3, #1 ; 0x1 | |
150 | * 59718: eafffff0 b 0x596e0 | |
151 | * 5971c: e1e05005 mvn r5, r5 | |
152 | * 59720: e5943000 ldr r3, [r4] | |
153 | * 59724: e0533005 subs r3, r3, r5 | |
154 | * 59728: 03a08000 moveq r8, #0 ; 0x0 | |
155 | * 5972c: e1a00008 mov r0, r8 | |
156 | * 59730: e1a0f00e mov r15, r14 | |
157 | * 59734: 04c11db7 strbeq r1, [r1], #3511 | |
158 | * 59738: e10f1000 mrs r1, CPSR | |
159 | * 5973c: e3c12080 bic r2, r1, #128 ; 0x80 | |
160 | * 59740: e3500001 cmp r0, #1 ; 0x1 | |
161 | * 59744: 23822080 orrcs r2, r2, #128 ; 0x80 | |
162 | * 59748: e129f002 msr CPSR_fc, r2 | |
163 | * 5974c: e1b01c81 lsls r1, r1, #25 | |
164 | * 59750: e3a00000 mov r0, #0 ; 0x0 | |
165 | * 59754: 23a00001 movcs r0, #1 ; 0x1 | |
166 | * 59758: e1a0f00e mov r15, r14 | |
167 | * 5975c: e10f1000 mrs r1, CPSR | |
168 | * 59760: e3a02001 mov r2, #1 ; 0x1 | |
169 | * 59764: e00203e1 and r0, r2, r1, ror #7 | |
170 | * 59768: e1a0f00e mov r15, r14 | |
171 | * 5976c: ee151f70 mrc 15, 0, r1, cr5, cr0, {3} | |
172 | * 59770: e3a02001 mov r2, #1 ; 0x1 | |
173 | * 59774: e0020261 and r0, r2, r1, ror #4 | |
174 | * 59778: e1a0f00e mov r15, r14 | |
175 | * 5977c: e3a00000 mov r0, #0 ; 0x0 | |
176 | * 59780: ee070f16 mcr 15, 0, r0, cr7, cr6, {0} | |
177 | * 59784: e1a0f00e mov r15, r14 | |
178 | * 59788: e92d0300 push {r8, r9} | |
179 | * 5978c: e3a00001 mov r0, #1 ; 0x1 | |
180 | * 59790: e59f83bc ldr r8, [pc, #956] ; 0x59b54 | |
181 | * 59794: e5880000 str r0, [r8] | |
182 | * 59798: e3a0000a mov r0, #10 ; 0xa | |
183 | * 5979c: e59f83b4 ldr r8, [pc, #948] ; 0x59b58 | |
184 | * 597a0: e5880000 str r0, [r8] | |
185 | * 597a4: e3a00004 mov r0, #4 ; 0x4 | |
186 | * 597a8: e59f83ac ldr r8, [pc, #940] ; 0x59b5c | |
187 | * 597ac: e5880000 str r0, [r8] | |
188 | * 597b0: e59f93a8 ldr r9, [pc, #936] ; 0x59b60 | |
189 | * 597b4: e5990000 ldr r0, [r9] | |
190 | * 597b8: e3800001 orr r0, r0, #1 ; 0x1 | |
191 | * 597bc: e59f839c ldr r8, [pc, #924] ; 0x59b60 | |
192 | * 597c0: e5880000 str r0, [r8] | |
193 | * 597c4: eafffffe b 0x597c4 | |
194 | * 597c8: e92d4370 push {r4, r5, r6, r8, r9, r14} | |
195 | * 597cc: e1a06000 mov r6, r0 | |
196 | * 597d0: e3a05000 mov r5, #0 ; 0x0 | |
197 | * 597d4: e5960000 ldr r0, [r6] | |
198 | * 597d8: e5961004 ldr r1, [r6, #4] | |
199 | * 597dc: e1500001 cmp r0, r1 | |
200 | * 597e0: 2a000006 bcs 0x59800 | |
201 | * 597e4: e5960000 ldr r0, [r6] | |
202 | * 597e8: e5d05000 ldrb r5, [r0] | |
203 | * 597ec: e5960000 ldr r0, [r6] | |
204 | * 597f0: e2800001 add r0, r0, #1 ; 0x1 | |
205 | * 597f4: e5860000 str r0, [r6] | |
206 | * 597f8: e1a00005 mov r0, r5 | |
207 | * 597fc: ea000001 b 0x59808 | |
208 | * 59800: ebffffe0 bl 0x59788 | |
209 | * 59804: e1a00005 mov r0, r5 | |
210 | * 59808: e8bd8370 pop {r4, r5, r6, r8, r9, r15} | |
211 | * 5980c: e92d43f0 push {r4, r5, r6, r7, r8, r9, r14} | |
212 | * 59810: e1a07000 mov r7, r0 | |
213 | * 59814: e1a06001 mov r6, r1 | |
214 | * 59818: e5961000 ldr r1, [r6] | |
215 | * 5981c: e5962004 ldr r2, [r6, #4] | |
216 | * 59820: e1510002 cmp r1, r2 | |
217 | * 59824: 2a000005 bcs 0x59840 | |
218 | * 59828: e5961000 ldr r1, [r6] | |
219 | * 5982c: e5c17000 strb r7, [r1] | |
220 | * 59830: e5961000 ldr r1, [r6] | |
221 | * 59834: e2811001 add r1, r1, #1 ; 0x1 | |
222 | * 59838: e5861000 str r1, [r6] | |
223 | * 5983c: ea000000 b 0x59844 | |
224 | * 59840: ebffffd0 bl 0x59788 | |
225 | * 59844: e8bd83f0 pop {r4, r5, r6, r7, r8, r9, r15} | |
226 | * 59848: e92d4370 push {r4, r5, r6, r8, r9, r14} | |
227 | * 5984c: e1a06000 mov r6, r0 | |
228 | * 59850: e5d61008 ldrb r1, [r6, #8] | |
229 | * 59854: e3510080 cmp r1, #128 ; 0x80 | |
230 | * 59858: 1a000002 bne 0x59868 | |
231 | * 5985c: e1a00006 mov r0, r6 | |
232 | * 59860: ebffffd8 bl 0x597c8 | |
233 | * 59864: e5c60009 strb r0, [r6, #9] | |
234 | * 59868: e5d61008 ldrb r1, [r6, #8] | |
235 | * 5986c: e5d62009 ldrb r2, [r6, #9] | |
236 | * 59870: e0011002 and r1, r1, r2 | |
237 | * 59874: e20110ff and r1, r1, #255 ; 0xff | |
238 | * 59878: e1a05001 mov r5, r1 | |
239 | * 5987c: e5d61008 ldrb r1, [r6, #8] | |
240 | * 59880: e1a010a1 lsr r1, r1, #1 | |
241 | * 59884: e5c61008 strb r1, [r6, #8] | |
242 | * 59888: e5d61008 ldrb r1, [r6, #8] | |
243 | * 5988c: e3510000 cmp r1, #0 ; 0x0 | |
244 | * 59890: 1a000001 bne 0x5989c | |
245 | * 59894: e3a01080 mov r1, #128 ; 0x80 | |
246 | * 59898: e5c61008 strb r1, [r6, #8] | |
247 | * 5989c: e3550000 cmp r5, #0 ; 0x0 | |
248 | * 598a0: 0a000001 beq 0x598ac | |
249 | * 598a4: e3a00001 mov r0, #1 ; 0x1 | |
250 | * 598a8: ea000000 b 0x598b0 | |
251 | * 598ac: e3a00000 mov r0, #0 ; 0x0 | |
252 | * 598b0: e8bd8370 pop {r4, r5, r6, r8, r9, r15} | |
253 | * 598b4: e92d4ff0 push {r4, r5, r6, r7, r8, r9, r10, r11, r14} | |
254 | * 598b8: e1a0b000 mov r11, r0 | |
255 | * 598bc: e1a0a001 mov r10, r1 | |
256 | * 598c0: e24a1001 sub r1, r10, #1 ; 0x1 | |
257 | * 598c4: e3a02001 mov r2, #1 ; 0x1 | |
258 | * 598c8: e1a06112 lsl r6, r2, r1 | |
259 | * 598cc: e3a07000 mov r7, #0 ; 0x0 | |
260 | * 598d0: ea000015 b 0x5992c | |
261 | * 598d4: e5db1008 ldrb r1, [r11, #8] | |
262 | * 598d8: e3510080 cmp r1, #128 ; 0x80 | |
263 | * 598dc: 1a000003 bne 0x598f0 | |
264 | * 598e0: e1a0000b mov r0, r11 | |
265 | * 598e4: ebffffb7 bl 0x597c8 | |
266 | * 598e8: e1a01000 mov r1, r0 | |
267 | * 598ec: e5cb1009 strb r1, [r11, #9] | |
268 | * 598f0: e5db1008 ldrb r1, [r11, #8] | |
269 | * 598f4: e5db2009 ldrb r2, [r11, #9] | |
270 | * 598f8: e0011002 and r1, r1, r2 | |
271 | * 598fc: e3510000 cmp r1, #0 ; 0x0 | |
272 | * 59900: 0a000000 beq 0x59908 | |
273 | * 59904: e1877006 orr r7, r7, r6 | |
274 | * 59908: e1a060a6 lsr r6, r6, #1 | |
275 | * 5990c: e5db2008 ldrb r2, [r11, #8] | |
276 | * 59910: e1a020a2 lsr r2, r2, #1 | |
277 | * 59914: e5cb2008 strb r2, [r11, #8] | |
278 | * 59918: e5db1008 ldrb r1, [r11, #8] | |
279 | * 5991c: e3510000 cmp r1, #0 ; 0x0 | |
280 | * 59920: 1a000001 bne 0x5992c | |
281 | * 59924: e3a01080 mov r1, #128 ; 0x80 | |
282 | * 59928: e5cb1008 strb r1, [r11, #8] | |
283 | * 5992c: e3560000 cmp r6, #0 ; 0x0 | |
284 | * 59930: 1affffe7 bne 0x598d4 | |
285 | * 59934: e1a00007 mov r0, r7 | |
286 | * 59938: e8bd8ff0 pop {r4, r5, r6, r7, r8, r9, r10, r11, r15} | |
287 | * 5993c: e92d4ff0 push {r4, r5, r6, r7, r8, r9, r10, r11, r14} | |
288 | * 59940: e24dd004 sub r13, r13, #4 ; 0x4 | |
289 | * 59944: e1a0a000 mov r10, r0 | |
290 | * 59948: e58d1000 str r1, [r13] | |
291 | * 5994c: e3a05001 mov r5, #1 ; 0x1 | |
292 | * 59950: e1a0000a mov r0, r10 | |
293 | * 59954: ebffffbb bl 0x59848 | |
294 | * 59958: e1a02000 mov r2, r0 | |
295 | * 5995c: e3520000 cmp r2, #0 ; 0x0 | |
296 | * 59960: 0a00000f beq 0x599a4 | |
297 | * 59964: e1a0000a mov r0, r10 | |
298 | * 59968: e3a01008 mov r1, #8 ; 0x8 | |
299 | * 5996c: ebffffd0 bl 0x598b4 | |
300 | * 59970: e20020ff and r2, r0, #255 ; 0xff | |
301 | * 59974: e1a04002 mov r4, r2 | |
302 | * 59978: e59d1000 ldr r1, [r13] | |
303 | * 5997c: e1a00004 mov r0, r4 | |
304 | * 59980: ebffffa1 bl 0x5980c | |
305 | * 59984: e59f21d8 ldr r2, [pc, #472] ; 0x59b64 | |
306 | * 59988: e0852002 add r2, r5, r2 | |
307 | * 5998c: e5c24000 strb r4, [r2] | |
308 | * 59990: e2852001 add r2, r5, #1 ; 0x1 | |
309 | * 59994: e1a02b02 lsl r2, r2, #22 | |
310 | * 59998: e1a02b22 lsr r2, r2, #22 | |
311 | * 5999c: e1a05002 mov r5, r2 | |
312 | * 599a0: eaffffea b 0x59950 | |
313 | * 599a4: e1a0000a mov r0, r10 | |
314 | * 599a8: e3a0100a mov r1, #10 ; 0xa | |
315 | * 599ac: ebffffc0 bl 0x598b4 | |
316 | * 599b0: e1a02000 mov r2, r0 | |
317 | * 599b4: e1a0b002 mov r11, r2 | |
318 | * 599b8: e35b0000 cmp r11, #0 ; 0x0 | |
319 | * 599bc: 0a00001b beq 0x59a30 | |
320 | * 599c0: e1a0000a mov r0, r10 | |
321 | * 599c4: e3a01004 mov r1, #4 ; 0x4 | |
322 | * 599c8: ebffffb9 bl 0x598b4 | |
323 | * 599cc: e1a02000 mov r2, r0 | |
324 | * 599d0: e1a07002 mov r7, r2 | |
325 | * 599d4: e2877001 add r7, r7, #1 ; 0x1 | |
326 | * 599d8: e3a06000 mov r6, #0 ; 0x0 | |
327 | * 599dc: ea000010 b 0x59a24 | |
328 | * 599e0: e086200b add r2, r6, r11 | |
329 | * 599e4: e1a02b02 lsl r2, r2, #22 | |
330 | * 599e8: e1a02b22 lsr r2, r2, #22 | |
331 | * 599ec: e59f3170 ldr r3, [pc, #368] ; 0x59b64 | |
332 | * 599f0: e0822003 add r2, r2, r3 | |
333 | * 599f4: e5d24000 ldrb r4, [r2] | |
334 | * 599f8: e59d1000 ldr r1, [r13] | |
335 | * 599fc: e1a00004 mov r0, r4 | |
336 | * 59a00: ebffff81 bl 0x5980c | |
337 | * 59a04: e59f2158 ldr r2, [pc, #344] ; 0x59b64 | |
338 | * 59a08: e0852002 add r2, r5, r2 | |
339 | * 59a0c: e5c24000 strb r4, [r2] | |
340 | * 59a10: e2852001 add r2, r5, #1 ; 0x1 | |
341 | * 59a14: e1a02b02 lsl r2, r2, #22 | |
342 | * 59a18: e1a02b22 lsr r2, r2, #22 | |
343 | * 59a1c: e1a05002 mov r5, r2 | |
344 | * 59a20: e2866001 add r6, r6, #1 ; 0x1 | |
345 | * 59a24: e1560007 cmp r6, r7 | |
346 | * 59a28: daffffec ble 0x599e0 | |
347 | * 59a2c: eaffffc7 b 0x59950 | |
348 | * 59a30: e28dd004 add r13, r13, #4 ; 0x4 | |
349 | * 59a34: e8bd8ff0 pop {r4, r5, r6, r7, r8, r9, r10, r11, r15} | |
650ebf3b MG |
350 | * 59a38: e92d4ff0 push {r4, r5, r6, r7, r8, r9, r10, r11, r14} |
351 | * 59a3c: e1a07000 mov r7, r0 | |
352 | * 59a40: e1a0a001 mov r10, r1 | |
353 | * 59a44: e1a0b002 mov r11, r2 | |
354 | * 59a48: ebfffeae bl 0x59508 | |
355 | * 59a4c: e3a03033 mov r3, #51 ; 0x33 | |
356 | * 59a50: e3a0203f mov r2, #63 ; 0x3f | |
357 | * 59a54: e3a01000 mov r1, #0 ; 0x0 | |
358 | * 59a58: e3a00000 mov r0, #0 ; 0x0 | |
359 | * 59a5c: ebfffec5 bl 0x59578 | |
360 | * 59a60: e59f3100 ldr r3, [pc, #256] ; 0x59b68 | |
361 | * 59a64: e3a02033 mov r2, #51 ; 0x33 | |
362 | * 59a68: e3a01540 mov r1, #268435456 ; 0x10000000 | |
363 | * 59a6c: e3a00004 mov r0, #4 ; 0x4 | |
364 | * 59a70: ebfffec0 bl 0x59578 | |
365 | * 59a74: e59f30f0 ldr r3, [pc, #240] ; 0x59b6c | |
366 | * 59a78: e3a0201b mov r2, #27 ; 0x1b | |
367 | * 59a7c: e3a01550 mov r1, #335544320 ; 0x14000000 | |
368 | * 59a80: e3a00005 mov r0, #5 ; 0x5 | |
369 | * 59a84: ebfffebb bl 0x59578 | |
370 | * 59a88: e3a03033 mov r3, #51 ; 0x33 | |
371 | * 59a8c: e3a0203b mov r2, #59 ; 0x3b | |
372 | * 59a90: e3a014c0 mov r1, #-1073741824 ; 0xc0000000 | |
373 | * 59a94: e3a00007 mov r0, #7 ; 0x7 | |
374 | * 59a98: ebfffeb6 bl 0x59578 | |
375 | * 59a9c: e59f00cc ldr r0, [pc, #204] ; 0x59b70 | |
376 | * 59aa0: ebfffeae bl 0x59560 | |
377 | * 59aa4: e59b5000 ldr r5, [r11] | |
378 | * 59aa8: e59f20c4 ldr r2, [pc, #196] ; 0x59b74 | |
379 | * 59aac: e1550002 cmp r5, r2 | |
380 | * 59ab0: 0a000000 beq 0x59ab8 | |
381 | * 59ab4: ebffff33 bl 0x59788 | |
382 | * 59ab8: e28b3004 add r3, r11, #4 ; 0x4 | |
383 | * 59abc: e5935000 ldr r5, [r3] | |
384 | * 59ac0: e0853007 add r3, r5, r7 | |
385 | * 59ac4: e153000a cmp r3, r10 | |
386 | * 59ac8: 3a000000 bcc 0x59ad0 | |
387 | * 59acc: ebffff2d bl 0x59788 | |
388 | * 59ad0: e28b2008 add r2, r11, #8 ; 0x8 | |
389 | * 59ad4: e59f809c ldr r8, [pc, #156] ; 0x59b78 | |
390 | * 59ad8: e5882000 str r2, [r8] | |
391 | * 59adc: e085200b add r2, r5, r11 | |
392 | * 59ae0: e59f8090 ldr r8, [pc, #144] ; 0x59b78 | |
393 | * 59ae4: e5882004 str r2, [r8, #4] | |
394 | * 59ae8: e3a02000 mov r2, #0 ; 0x0 | |
395 | * 59aec: e59f8084 ldr r8, [pc, #132] ; 0x59b78 | |
396 | * 59af0: e5c82009 strb r2, [r8, #9] | |
397 | * 59af4: e3a02080 mov r2, #128 ; 0x80 | |
398 | * 59af8: e59f8078 ldr r8, [pc, #120] ; 0x59b78 | |
399 | * 59afc: e5c82008 strb r2, [r8, #8] | |
400 | * 59b00: e59f8074 ldr r8, [pc, #116] ; 0x59b7c | |
401 | * 59b04: e5887000 str r7, [r8] | |
402 | * 59b08: e0853007 add r3, r5, r7 | |
403 | * 59b0c: e59f8068 ldr r8, [pc, #104] ; 0x59b7c | |
404 | * 59b10: e5883004 str r3, [r8, #4] | |
405 | * 59b14: e59f1060 ldr r1, [pc, #96] ; 0x59b7c | |
406 | * 59b18: e59f0058 ldr r0, [pc, #88] ; 0x59b78 | |
407 | * 59b1c: ebffff86 bl 0x5993c | |
408 | * 59b20: e2873020 add r3, r7, #32 ; 0x20 | |
409 | * 59b24: e5935000 ldr r5, [r3] | |
410 | * 59b28: e59f2050 ldr r2, [pc, #80] ; 0x59b80 | |
411 | * 59b2c: e1a01005 mov r1, r5 | |
412 | * 59b30: e1a00007 mov r0, r7 | |
413 | * 59b34: ebfffed2 bl 0x59684 | |
414 | * 59b38: e1a01000 mov r1, r0 | |
415 | * 59b3c: e1a04001 mov r4, r1 | |
416 | * 59b40: e3540000 cmp r4, #0 ; 0x0 | |
417 | * 59b44: 0a000000 beq 0x59b4c | |
418 | * 59b48: ebffff0e bl 0x59788 | |
419 | * 59b4c: ebfffe6d bl 0x59508 | |
420 | * 59b50: e8bd8ff0 pop {r4, r5, r6, r7, r8, r9, r10, r11, r15} | |
421 | * 59b54: c00b003c andgt r0, r11, r12, lsr r0 | |
422 | * 59b58: c00b0038 andgt r0, r11, r8, lsr r0 | |
423 | * 59b5c: c00b0034 andgt r0, r11, r4, lsr r0 | |
424 | * 59b60: c00b0030 andgt r0, r11, r0, lsr r0 | |
425 | * 59b64: 14000418 strne r0, [r0], #-1048 | |
426 | * 59b68: 00000366 andeq r0, r0, r6, ror #6 | |
427 | * 59b6c: 00000733 andeq r0, r0, r3, lsr r7 | |
428 | * 59b70: 00001005 andeq r1, r0, r5 | |
429 | * 59b74: 6110beef tstvs r0, r15, ror #29 <- LZW Header... | |
430 | * 59b78: 14000404 strne r0, [r0], #-1028 | |
431 | * 59b7c: 14000410 strne r0, [r0], #-1040 | |
432 | * 59b80: 46335053 undefined | |
433 | */ | |
90836933 | 434 | |
e4a6d4c3 | 435 | void fn_59788(const char *fname) |
14ff7444 | 436 | { |
e4a6d4c3 | 437 | fprintf(stderr,"%s: error extracting...\n", fname); |
14ff7444 MG |
438 | exit(1); |
439 | } | |
440 | ||
441 | struct s_59b78 { | |
5e9ad31f MG |
442 | unsigned char *start; /* 0 */ |
443 | unsigned char *stop; /* 4 */ | |
14ff7444 MG |
444 | unsigned char y; /* 8 */ |
445 | unsigned char x; /* 9 */ | |
446 | }; | |
447 | ||
90c723bb | 448 | unsigned char fn_597c8(struct s_59b78 *r6_data) |
af1fed3a | 449 | { |
5e9ad31f MG |
450 | unsigned char *r0; |
451 | unsigned char *r1; | |
452 | unsigned char r5; | |
453 | ||
454 | r5 = 0; | |
455 | ||
456 | r0 = r6_data->start; | |
457 | r1 = r6_data->stop; | |
458 | ||
459 | if (r1 < r0) | |
e4a6d4c3 | 460 | fn_59788(__func__); |
5e9ad31f MG |
461 | |
462 | r5 = *r0; | |
463 | r0++; | |
464 | r6_data->start = r0; | |
465 | ||
466 | return r5; | |
af1fed3a MG |
467 | } |
468 | ||
e4a6d4c3 MG |
469 | unsigned int fn_59848(struct s_59b78 *r6_data) |
470 | { | |
90c723bb MG |
471 | unsigned char r1; |
472 | unsigned char r2; | |
e4a6d4c3 MG |
473 | unsigned int r5; |
474 | ||
475 | r1 = r6_data->y; | |
476 | if (r1 == 0x80) { | |
477 | r6_data->x = fn_597c8(r6_data); | |
478 | } | |
479 | r1 = r6_data->y; | |
480 | r2 = r6_data->x; | |
481 | r1 = r1 & r2; | |
482 | r5 = r1 & 0xff; | |
483 | ||
484 | r1 = r6_data->y; | |
485 | r1 = r1 >> 1; | |
486 | r6_data->y = r1; | |
90c723bb | 487 | if (r1 == 0) { |
e4a6d4c3 | 488 | r1 = 0x80; |
90c723bb MG |
489 | r6_data->y = r1; |
490 | } | |
491 | ||
e4a6d4c3 MG |
492 | if (r5 == 0) |
493 | return 0; | |
494 | ||
495 | return 1; | |
496 | } | |
497 | ||
3772880c MG |
498 | unsigned int fn_598b4(struct s_59b78 *r11_data, unsigned int r10_arg2) |
499 | { | |
500 | unsigned int r1; | |
501 | unsigned int r2; | |
502 | unsigned int r6; | |
503 | unsigned int r7; | |
504 | ||
3772880c MG |
505 | r1 = r10_arg2 - 1; |
506 | r6 = 1 << r1; | |
507 | ||
508 | r7 = 0; | |
90c723bb | 509 | while (r6 != 0) { |
3772880c MG |
510 | r1 = r11_data->y; |
511 | if (r1 == 0x80) { | |
512 | r1 = fn_597c8(r11_data); | |
90c723bb | 513 | r11_data->x = r1; |
3772880c | 514 | } |
3772880c MG |
515 | r1 = r11_data->y; |
516 | r2 = r11_data->x; | |
517 | r1 = r1 & r2; | |
518 | if (r1 != 0) | |
519 | r7 = r7 | r6; | |
520 | ||
521 | r6 = r6 >> 1; | |
522 | ||
523 | r2 = r11_data->y; | |
524 | r2 = r2 >> 1; | |
525 | r11_data->y = r2; | |
526 | ||
527 | r1 = r11_data->y; | |
528 | if(r1 == 0) { | |
529 | r11_data->y = 0x80; | |
530 | } | |
90c723bb | 531 | } |
3772880c MG |
532 | |
533 | return r7; | |
534 | } | |
535 | ||
af1fed3a MG |
536 | void fn_5980c(unsigned int arg1, unsigned int mem[]) |
537 | { | |
9897bfc3 MG |
538 | unsigned char *r1; |
539 | unsigned char *r2; | |
540 | ||
541 | r1 = (unsigned char*)mem[0]; | |
542 | r2 = (unsigned char*)mem[1]; | |
543 | ||
e4a6d4c3 MG |
544 | if (r1 > r2) { |
545 | printf("r1: 0x%08x, r2: 0x%08x\n", (unsigned int)r1, (unsigned int)r2); | |
546 | fn_59788(__func__); | |
547 | } | |
9897bfc3 MG |
548 | |
549 | *r1 = arg1 & 0xff; | |
550 | ||
551 | r1++; | |
552 | mem[0] = (unsigned int)r1; | |
af1fed3a MG |
553 | } |
554 | ||
90c723bb | 555 | void fn_5993c(struct s_59b78 *r10_data, unsigned int r13_mem[]) |
af1fed3a MG |
556 | { |
557 | unsigned int r5; | |
558 | unsigned int r2; | |
90c723bb | 559 | unsigned char r4; |
05c92ac4 MG |
560 | unsigned int r6; |
561 | unsigned int r7; | |
562 | unsigned int r11; | |
90c723bb | 563 | unsigned char arr_59b64[2048]; |
af1fed3a MG |
564 | |
565 | r5 = 1; | |
566 | ||
90c723bb MG |
567 | while (1) { |
568 | while (1) { | |
569 | r2 = fn_59848(r10_data); | |
05c92ac4 MG |
570 | if (r2 == 0) |
571 | break; | |
af1fed3a | 572 | |
90c723bb | 573 | r2 = fn_598b4(r10_data, 8) & 0xff; |
05c92ac4 | 574 | r4 = r2; |
af1fed3a | 575 | |
90c723bb | 576 | fn_5980c(r4, r13_mem); |
05c92ac4 MG |
577 | arr_59b64[r5] = r4 & 0xff; |
578 | r2 = r5 + 1; | |
579 | r2 = r2 << 22; | |
580 | r2 = r2 >> 22; | |
581 | r5 = r2; | |
90c723bb | 582 | } |
af1fed3a | 583 | |
90c723bb | 584 | r11 = fn_598b4(r10_data, 0x0a); |
05c92ac4 MG |
585 | if(r11 == 0) |
586 | return; | |
af1fed3a | 587 | |
90c723bb | 588 | r2 = fn_598b4(r10_data, 0x04); |
05c92ac4 MG |
589 | r7 = r2 + 1; |
590 | r6 = 0; | |
90c723bb | 591 | while (r6 <= r7) { |
05c92ac4 MG |
592 | r2 = r6 + r11; |
593 | r2 = r2 << 22; | |
594 | r2 = r2 >> 22; | |
595 | r4 = arr_59b64[r2]; | |
90c723bb MG |
596 | fn_5980c(r4, r13_mem); |
597 | arr_59b64[r5] = r4; | |
05c92ac4 MG |
598 | r2 = r5 + 1; |
599 | r2 = r2 << 22; | |
600 | r2 = r2 >> 22; | |
601 | r5 = r2; | |
602 | r6++; | |
90c723bb MG |
603 | } |
604 | } | |
af1fed3a MG |
605 | } |
606 | ||
607 | unsigned int crc_check_59684(unsigned char *arg1, unsigned int arg2, unsigned int magic) | |
608 | { | |
609 | unsigned int r3; | |
610 | unsigned int r4; | |
611 | unsigned int r5; | |
612 | ||
613 | #if 0 | |
614 | if (r0 < 0xc0000000) | |
615 | return 1; | |
616 | #endif | |
617 | ||
e433bc03 | 618 | /* ??? */ |
af1fed3a MG |
619 | r4 = *((unsigned int*)arg1 + 0x20); |
620 | r5 = *((unsigned int*)arg1 + 0x24); | |
621 | ||
e433bc03 | 622 | printf("magic: 0x%08x <-> 0x%08x\n", r5, magic); |
af1fed3a MG |
623 | if (r5 != magic) |
624 | return 2; | |
625 | ||
626 | if (arg2 >= r4) | |
627 | r5 = 0; | |
628 | else | |
629 | return 3; | |
630 | ||
631 | r5 = ~rsb_crc(~0x00, arg1, r4); | |
632 | r3 = *((unsigned int*)(arg1 + r4)); | |
633 | printf("Checksums: 0x%02x <-> 0x%02x\n", r5, r3); | |
634 | ||
635 | if (r3 == r5) | |
636 | return 0; | |
637 | ||
05c92ac4 | 638 | return 4; |
af1fed3a MG |
639 | } |
640 | ||
e433bc03 MG |
641 | void mkdir_p(char *dir) |
642 | { | |
643 | char *copy, *parent; | |
644 | ||
645 | if ((dir == NULL) || (!strcmp(dir, "."))) | |
646 | return; | |
647 | ||
648 | if ((copy = strdup(dir)) == NULL) { | |
649 | perror("strdup"); | |
650 | exit(1); | |
651 | } | |
652 | parent = dirname(copy); | |
653 | mkdir_p(parent); | |
654 | ||
655 | errno = 0; | |
656 | if (mkdir(dir, 0755) == -1) { | |
657 | if (errno != EEXIST) { | |
658 | fprintf(stderr, "%s: ", dir); | |
659 | perror("mkdir"); | |
660 | exit(1); | |
661 | } | |
662 | } | |
663 | free(copy); | |
664 | } | |
665 | ||
666 | void write_file(char *fname, unsigned char *buf, int len) | |
14ff7444 | 667 | { |
e433bc03 MG |
668 | char filename[PATH_MAX]; |
669 | char *filename_c, *dirn; | |
670 | int fd; | |
671 | int remaining; | |
672 | int ret; | |
673 | ||
674 | strcpy(filename, "extracted/"); | |
675 | strcat(filename, fname); | |
676 | ||
677 | if ((filename_c = strdup(filename)) == NULL) { | |
678 | perror("strdup"); | |
679 | exit(1); | |
680 | } | |
681 | dirn = dirname(filename_c); | |
682 | mkdir_p(dirn); | |
683 | free(filename_c); | |
684 | ||
685 | if ((fd = open(filename, O_WRONLY|O_CREAT, 0644)) == -1) { | |
686 | fprintf(stderr, "%s: ", filename); | |
687 | perror("open"); | |
688 | exit(1); | |
689 | } | |
690 | ||
691 | remaining = len; | |
692 | ||
693 | while(remaining) { | |
694 | ret = write(fd, buf + (len - remaining), remaining); | |
695 | if (ret < 0) { | |
696 | perror("write"); | |
697 | exit(1); | |
698 | } | |
699 | remaining -= ret; | |
700 | } | |
701 | ||
702 | printf(", %s written.\n", filename); | |
703 | ||
704 | close(fd); | |
14ff7444 MG |
705 | } |
706 | ||
707 | void extract_lz_file(unsigned char *buf, unsigned char *name) | |
708 | { | |
14ff7444 | 709 | unsigned char *r3; |
14ff7444 | 710 | unsigned int r5; |
14ff7444 | 711 | unsigned char *r7 = NULL; /* Arg1, mem start */ |
14ff7444 MG |
712 | unsigned char *r10 = NULL; /* Arg2, mem end */ |
713 | unsigned char *r11 = buf; /* Arg3 */ | |
14ff7444 MG |
714 | struct s_59b78 struct1; |
715 | unsigned int arr_59b7c[1024]; | |
716 | ||
14ff7444 | 717 | if (*((unsigned int*)r11) != LZ_MAGIC) |
e4a6d4c3 MG |
718 | fn_59788(__func__); |
719 | ||
14ff7444 MG |
720 | r3 = r11 + 4; |
721 | r5 = *((unsigned int*)r3); | |
ee856c69 | 722 | printf(", length: %d", r5); |
14ff7444 | 723 | |
e433bc03 MG |
724 | if ((r7 = malloc(r5)) == NULL) { |
725 | perror("malloc"); | |
726 | exit(1); | |
727 | } | |
728 | r10 = r7 + r5; | |
729 | bzero(r7, r5); | |
730 | ||
14ff7444 MG |
731 | r3 = r7 + r5; |
732 | if (r3 > r10) | |
e4a6d4c3 | 733 | fn_59788(__func__); |
14ff7444 MG |
734 | |
735 | struct1.start = r11 + 8; | |
736 | struct1.stop = r5 + r11; | |
737 | struct1.x = 0; | |
738 | struct1.y = 0x80; | |
739 | ||
740 | arr_59b7c[0] = (unsigned int)r7; | |
741 | arr_59b7c[1] = (unsigned int)(r5 + r7); | |
742 | ||
743 | fn_5993c(&struct1, arr_59b7c); | |
744 | ||
e433bc03 MG |
745 | #if 0 |
746 | /* This seems to still be completely broken */ | |
af1fed3a MG |
747 | r3 = r7 + 0x20; |
748 | r5 = *((unsigned int*)r3); | |
749 | ||
e433bc03 MG |
750 | if ((ret = crc_check_59684(r7, r5, 0x46335053)) != 0) { |
751 | printf("crc_check return: %d\n", ret); | |
e4a6d4c3 | 752 | fn_59788(__func__); |
e433bc03 MG |
753 | } |
754 | #endif | |
af1fed3a | 755 | |
e433bc03 MG |
756 | write_file((char*)name, r7, r5); |
757 | ||
14ff7444 MG |
758 | free(r7); |
759 | } | |
760 | ||
90836933 MG |
761 | void search_lz_sections(unsigned char *fw, int len) |
762 | { | |
763 | int i; | |
764 | unsigned char *j; | |
765 | ||
766 | for(i = 0; i < len - 4; i++) { | |
767 | if (*((unsigned int*)(fw+i)) == LZ_MAGIC) { | |
768 | j = fw + i - 1; | |
90836933 MG |
769 | printf("0x%02x: ", i); |
770 | j--; | |
771 | while (j > fw) { | |
f1fd0cb0 MG |
772 | if (!strncmp("SP3", (char*)j, 3)) { |
773 | unsigned char fname[5]; | |
774 | ||
775 | bzero(fname, sizeof(fname)); | |
776 | memcpy(fname, j, 4); | |
777 | printf("Firmware found: %s", fname); | |
778 | extract_lz_file(fw + i, fname); | |
779 | break; | |
780 | } | |
90836933 | 781 | if (*j == 0x00) { |
f1fd0cb0 | 782 | if ((*(j+1) != '/')) { |
e433bc03 | 783 | printf("ignoring...\n"); |
90c723bb | 784 | break; |
e433bc03 | 785 | } |
90836933 | 786 | printf("%s", j+1); |
14ff7444 | 787 | extract_lz_file(fw + i, j+1); |
90836933 MG |
788 | break; |
789 | } | |
790 | j--; | |
791 | } | |
90836933 MG |
792 | } |
793 | } | |
794 | } |