1 |
/* |
2 |
* Copyright (C) 2003-2007 Anders Gavare. All rights reserved. |
3 |
* |
4 |
* Redistribution and use in source and binary forms, with or without |
5 |
* modification, are permitted provided that the following conditions are met: |
6 |
* |
7 |
* 1. Redistributions of source code must retain the above copyright |
8 |
* notice, this list of conditions and the following disclaimer. |
9 |
* 2. Redistributions in binary form must reproduce the above copyright |
10 |
* notice, this list of conditions and the following disclaimer in the |
11 |
* documentation and/or other materials provided with the distribution. |
12 |
* 3. The name of the author may not be used to endorse or promote products |
13 |
* derived from this software without specific prior written permission. |
14 |
* |
15 |
* THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND |
16 |
* ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE |
17 |
* IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE |
18 |
* ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE |
19 |
* FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL |
20 |
* DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS |
21 |
* OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) |
22 |
* HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT |
23 |
* LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY |
24 |
* OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF |
25 |
* SUCH DAMAGE. |
26 |
* |
27 |
* |
28 |
* $Id: bootblock_iso9660.c,v 1.2 2007/03/16 15:17:55 debug Exp $ |
29 |
* |
30 |
* ISO9660 CD-ROM "bootblock" handling. |
31 |
* |
32 |
* There is really no bootblock; instead, the file which is to be booted |
33 |
* is extracted into a temporary file, and started as if it was given |
34 |
* as a normal file argument on the command line. |
35 |
* |
36 |
* TODO: This is really ugly. It's a quick hack. All the magic constants |
37 |
* need to be replaced with real code! |
38 |
*/ |
39 |
|
40 |
#include <stdio.h> |
41 |
#include <stdlib.h> |
42 |
#include <string.h> |
43 |
#include <sys/types.h> |
44 |
#include <unistd.h> |
45 |
|
46 |
#include "cpu.h" |
47 |
#include "diskimage.h" |
48 |
#include "machine.h" |
49 |
#include "misc.h" |
50 |
|
51 |
/* #define ISO_DEBUG */ |
52 |
|
53 |
|
54 |
static void debug_print_volume_id_and_filename(int iso_type, |
55 |
unsigned char *buf, char *filename) |
56 |
{ |
57 |
/* Volume ID: */ |
58 |
char str[35]; |
59 |
int i, ofs = iso_type == 3? 48 : 40; |
60 |
|
61 |
memcpy(str, buf + ofs, sizeof(str)); |
62 |
str[32] = '\0'; i = 31; |
63 |
|
64 |
while (i >= 0 && str[i]==' ') |
65 |
str[i--] = '\0'; |
66 |
if (str[0]) |
67 |
debug("\"%s\"", str); |
68 |
else { |
69 |
/* System ID: */ |
70 |
ofs = iso_type == 3? 16 : 8; |
71 |
memcpy(str, buf + ofs, sizeof(str)); |
72 |
str[32] = '\0'; i = 31; |
73 |
while (i >= 0 && str[i]==' ') |
74 |
str[i--] = '\0'; |
75 |
if (str[0]) |
76 |
debug("\"%s\"", str); |
77 |
else |
78 |
debug("(no ID)"); |
79 |
} |
80 |
|
81 |
debug(":%s\n", filename); |
82 |
} |
83 |
|
84 |
|
85 |
/* |
86 |
* iso_load_bootblock(): |
87 |
* |
88 |
* Try to load a kernel from an ISO 9660 disk image. iso_type is 1 for |
89 |
* "CD001" (standard), 2 for "CDW01" (ECMA), and 3 for "CDROM" (Sierra). |
90 |
* |
91 |
* TODO: This function uses too many magic offsets and so on; it should be |
92 |
* cleaned up some day. |
93 |
* |
94 |
* Returns 1 on success, 0 on failure. |
95 |
*/ |
96 |
int iso_load_bootblock(struct machine *m, struct cpu *cpu, |
97 |
int disk_id, int disk_type, int iso_type, unsigned char *buf, |
98 |
int *n_loadp, char ***load_namesp) |
99 |
{ |
100 |
int filenr, dirlen, res = 0, res2, iadd = DEBUG_INDENTATION; |
101 |
int found_dir; |
102 |
uint64_t dirofs; |
103 |
uint64_t fileofs, filelen; |
104 |
unsigned char *dirbuf = NULL, *dp; |
105 |
unsigned char *match_entry = NULL; |
106 |
char *p, *filename_orig; |
107 |
char *filename = strdup(cpu->machine->boot_kernel_filename); |
108 |
unsigned char *filebuf = NULL; |
109 |
char *tmpfname = NULL; |
110 |
char **new_array; |
111 |
int tmpfile_handle; |
112 |
|
113 |
if (filename == NULL) { |
114 |
fatal("out of memory\n"); |
115 |
exit(1); |
116 |
} |
117 |
filename_orig = filename; |
118 |
|
119 |
debug("ISO9660 boot:\n"); |
120 |
debug_indentation(iadd); |
121 |
|
122 |
debug_print_volume_id_and_filename(iso_type, buf, filename); |
123 |
|
124 |
|
125 |
/* |
126 |
* Traverse the directory structure to find the kernel. |
127 |
*/ |
128 |
|
129 |
dirlen = buf[0x84] + 256*buf[0x85] + 65536*buf[0x86]; |
130 |
if (dirlen != buf[0x8b] + 256*buf[0x8a] + 65536*buf[0x89]) |
131 |
fatal("WARNING: Root directory length mismatch?\n"); |
132 |
|
133 |
dirofs = (int64_t)(buf[0x8c] + (buf[0x8d] << 8) + (buf[0x8e] << 16) + |
134 |
((uint64_t)buf[0x8f] << 24)) * 2048; |
135 |
|
136 |
#ifdef ISO_DEBUG |
137 |
debug("root = %i bytes at 0x%llx\n", dirlen, (long long)dirofs); |
138 |
#endif |
139 |
|
140 |
dirbuf = malloc(dirlen); |
141 |
if (dirbuf == NULL) { |
142 |
fatal("out of memory in iso_load_bootblock()\n"); |
143 |
exit(1); |
144 |
} |
145 |
|
146 |
res2 = diskimage_access(m, disk_id, disk_type, 0, dirofs, dirbuf, |
147 |
dirlen); |
148 |
if (!res2) { |
149 |
fatal("Couldn't read the disk image. Aborting.\n"); |
150 |
goto ret; |
151 |
} |
152 |
|
153 |
found_dir = 1; /* Assume root dir */ |
154 |
dp = dirbuf; filenr = 1; |
155 |
p = NULL; |
156 |
while (dp < dirbuf + dirlen) { |
157 |
size_t i, nlen = dp[0]; |
158 |
int x = dp[2] + (dp[3] << 8) + (dp[4] << 16) + |
159 |
((uint64_t)dp[5] << 24); |
160 |
int y = dp[6] + (dp[7] << 8); |
161 |
char direntry[65]; |
162 |
|
163 |
dp += 8; |
164 |
|
165 |
/* |
166 |
* As long as there is an \ or / in the filename, then we |
167 |
* have not yet found the directory. |
168 |
*/ |
169 |
p = strchr(filename, '/'); |
170 |
if (p == NULL) |
171 |
p = strchr(filename, '\\'); |
172 |
|
173 |
#ifdef ISO_DEBUG |
174 |
debug("%i%s: %i, %i, \"", filenr, filenr == found_dir? |
175 |
" [CURRENT]" : "", x, y); |
176 |
#endif |
177 |
for (i=0; i<nlen && i<sizeof(direntry)-1; i++) |
178 |
if (dp[i]) { |
179 |
direntry[i] = dp[i]; |
180 |
#ifdef ISO_DEBUG |
181 |
debug("%c", dp[i]); |
182 |
#endif |
183 |
} else |
184 |
break; |
185 |
#ifdef ISO_DEBUG |
186 |
debug("\"\n"); |
187 |
#endif |
188 |
direntry[i] = '\0'; |
189 |
|
190 |
/* A directory name match? */ |
191 |
if ((p != NULL && strncasecmp(filename, direntry, nlen) == 0 |
192 |
&& nlen == (size_t)p - (size_t)filename && found_dir == y) |
193 |
|| (p == NULL && direntry[0] == '\0') ) { |
194 |
found_dir = filenr; |
195 |
if (p != NULL) |
196 |
filename = p+1; |
197 |
dirofs = 2048 * (int64_t)x; |
198 |
} |
199 |
|
200 |
dp += nlen; |
201 |
|
202 |
/* 16-bit aligned lenght: */ |
203 |
if (nlen & 1) |
204 |
dp ++; |
205 |
|
206 |
filenr ++; |
207 |
} |
208 |
|
209 |
p = strchr(filename, '/'); |
210 |
if (p == NULL) |
211 |
p = strchr(filename, '\\'); |
212 |
|
213 |
if (p != NULL) { |
214 |
char *blah = filename_orig; |
215 |
|
216 |
fatal("could not find '%s' in /", filename); |
217 |
|
218 |
/* Print the first part of the filename: */ |
219 |
while (blah != filename) |
220 |
fatal("%c", *blah++); |
221 |
|
222 |
fatal("\n"); |
223 |
goto ret; |
224 |
} |
225 |
|
226 |
/* debug("dirofs = 0x%llx\n", (long long)dirofs); */ |
227 |
|
228 |
/* Free the old dirbuf, and allocate a new one: */ |
229 |
free(dirbuf); |
230 |
dirbuf = malloc(512); |
231 |
if (dirbuf == NULL) { |
232 |
fatal("out of memory in iso_load_bootblock()\n"); |
233 |
exit(1); |
234 |
} |
235 |
|
236 |
for (;;) { |
237 |
size_t len, i; |
238 |
|
239 |
/* Too close to another sector? Then realign. */ |
240 |
if ((dirofs & 2047) + 70 > 2047) { |
241 |
dirofs = (dirofs | 2047) + 1; |
242 |
/* debug("realign dirofs = 0x%llx\n", dirofs); */ |
243 |
} |
244 |
|
245 |
res2 = diskimage_access(m, disk_id, disk_type, 0, dirofs, |
246 |
dirbuf, 256); |
247 |
if (!res2) { |
248 |
fatal("Couldn't read the disk image. Aborting.\n"); |
249 |
goto ret; |
250 |
} |
251 |
|
252 |
dp = dirbuf; |
253 |
len = dp[0]; |
254 |
if (len < 2) |
255 |
break; |
256 |
|
257 |
/* |
258 |
* TODO: Actually parse the directory entry! |
259 |
* |
260 |
* Haha, this must be rewritten. |
261 |
*/ |
262 |
|
263 |
#if 0 |
264 |
/* hahahaha */ |
265 |
printf("filename = '%s'\n", filename); |
266 |
{ |
267 |
int j; |
268 |
for (j=32; j<len; j++) |
269 |
printf("%c", dp[j] >= ' ' && dp[j] < 128? dp[j] : '.'); |
270 |
printf("\n"); |
271 |
} |
272 |
#endif |
273 |
|
274 |
for (i=32; i<len; i++) { |
275 |
if (i < len - strlen(filename)) |
276 |
if (strncmp(filename, (char *)dp + i, |
277 |
strlen(filename)) == 0) { |
278 |
/* The filename was found somewhere |
279 |
in the directory entry. */ |
280 |
if (match_entry != NULL) { |
281 |
fatal("TODO: I'm too lazy to" |
282 |
" implement a correct " |
283 |
"directory parser right " |
284 |
"now... (BUG)\n"); |
285 |
exit(1); |
286 |
} |
287 |
match_entry = malloc(512); |
288 |
if (match_entry == NULL) { |
289 |
fatal("out of memory\n"); |
290 |
exit(1); |
291 |
} |
292 |
memcpy(match_entry, dp, 512); |
293 |
break; |
294 |
} |
295 |
} |
296 |
|
297 |
if (match_entry != NULL) |
298 |
break; |
299 |
|
300 |
dirofs += len; |
301 |
} |
302 |
|
303 |
if (match_entry == NULL) { |
304 |
char *blah = filename_orig; |
305 |
|
306 |
fatal("could not find '%s' in /", filename); |
307 |
|
308 |
/* Print the first part of the filename: */ |
309 |
while (blah != filename) |
310 |
fatal("%c", *blah++); |
311 |
|
312 |
fatal("\n"); |
313 |
goto ret; |
314 |
} |
315 |
|
316 |
fileofs = match_entry[2] + (match_entry[3] << 8) + |
317 |
(match_entry[4] << 16) + ((uint64_t)match_entry[5] << 24); |
318 |
filelen = match_entry[10] + (match_entry[11] << 8) + |
319 |
(match_entry[12] << 16) + ((uint64_t)match_entry[13] << 24); |
320 |
fileofs *= 2048; |
321 |
|
322 |
/* debug("filelen=%llx fileofs=%llx\n", (long long)filelen, |
323 |
(long long)fileofs); */ |
324 |
|
325 |
filebuf = malloc(filelen); |
326 |
if (filebuf == NULL) { |
327 |
fatal("could not allocate %lli bytes to read the file" |
328 |
" from the disk image!\n", (long long)filelen); |
329 |
goto ret; |
330 |
} |
331 |
|
332 |
tmpfname = strdup("/tmp/gxemul.XXXXXXXXXXXX"); |
333 |
|
334 |
res2 = diskimage_access(m, disk_id, disk_type, 0, fileofs, filebuf, |
335 |
filelen); |
336 |
if (!res2) { |
337 |
fatal("could not read the file from the disk image!\n"); |
338 |
goto ret; |
339 |
} |
340 |
|
341 |
tmpfile_handle = mkstemp(tmpfname); |
342 |
if (tmpfile_handle < 0) { |
343 |
fatal("could not create %s\n", tmpfname); |
344 |
exit(1); |
345 |
} |
346 |
write(tmpfile_handle, filebuf, filelen); |
347 |
close(tmpfile_handle); |
348 |
|
349 |
debug("extracted %lli bytes into %s\n", (long long)filelen, tmpfname); |
350 |
|
351 |
/* Add the temporary filename to the load_namesp array: */ |
352 |
(*n_loadp)++; |
353 |
new_array = malloc(sizeof(char *) * (*n_loadp)); |
354 |
if (new_array == NULL) { |
355 |
fatal("out of memory\n"); |
356 |
exit(1); |
357 |
} |
358 |
memcpy(new_array, *load_namesp, sizeof(char *) * (*n_loadp)); |
359 |
*load_namesp = new_array; |
360 |
|
361 |
/* This adds a Backspace char in front of the filename; this |
362 |
is a special hack which causes the file to be removed once |
363 |
it has been loaded. */ |
364 |
tmpfname = realloc(tmpfname, strlen(tmpfname) + 2); |
365 |
memmove(tmpfname + 1, tmpfname, strlen(tmpfname) + 1); |
366 |
tmpfname[0] = 8; |
367 |
|
368 |
(*load_namesp)[*n_loadp - 1] = tmpfname; |
369 |
|
370 |
res = 1; |
371 |
|
372 |
ret: |
373 |
if (dirbuf != NULL) |
374 |
free(dirbuf); |
375 |
|
376 |
if (filebuf != NULL) |
377 |
free(filebuf); |
378 |
|
379 |
if (match_entry != NULL) |
380 |
free(match_entry); |
381 |
|
382 |
free(filename_orig); |
383 |
|
384 |
debug_indentation(-iadd); |
385 |
return res; |
386 |
} |
387 |
|