1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28#include <stdio.h>
29#include <string.h>
30#include <stdlib.h>
31#include <stdarg.h>
32#include <sys/types.h>
33#include <sys/stat.h>
34#include <unistd.h>
35#include <fcntl.h>
36#include <sys/mman.h>
37#include <tools/le_byteshift.h>
38
39typedef unsigned char u8;
40typedef unsigned short u16;
41typedef unsigned int u32;
42
43#define DEFAULT_MAJOR_ROOT 0
44#define DEFAULT_MINOR_ROOT 0
45#define DEFAULT_ROOT_DEV (DEFAULT_MAJOR_ROOT << 8 | DEFAULT_MINOR_ROOT)
46
47
48#define SETUP_SECT_MIN 5
49#define SETUP_SECT_MAX 64
50
51
52u8 buf[SETUP_SECT_MAX*512];
53
54#define PECOFF_RELOC_RESERVE 0x20
55
56#ifdef CONFIG_EFI_MIXED
57#define PECOFF_COMPAT_RESERVE 0x20
58#else
59#define PECOFF_COMPAT_RESERVE 0x0
60#endif
61
62static unsigned long efi32_stub_entry;
63static unsigned long efi64_stub_entry;
64static unsigned long efi_pe_entry;
65static unsigned long efi32_pe_entry;
66static unsigned long kernel_info;
67static unsigned long startup_64;
68static unsigned long _ehead;
69static unsigned long _end;
70
71
72
73static const u32 crctab32[] = {
74 0x00000000, 0x77073096, 0xee0e612c, 0x990951ba, 0x076dc419,
75 0x706af48f, 0xe963a535, 0x9e6495a3, 0x0edb8832, 0x79dcb8a4,
76 0xe0d5e91e, 0x97d2d988, 0x09b64c2b, 0x7eb17cbd, 0xe7b82d07,
77 0x90bf1d91, 0x1db71064, 0x6ab020f2, 0xf3b97148, 0x84be41de,
78 0x1adad47d, 0x6ddde4eb, 0xf4d4b551, 0x83d385c7, 0x136c9856,
79 0x646ba8c0, 0xfd62f97a, 0x8a65c9ec, 0x14015c4f, 0x63066cd9,
80 0xfa0f3d63, 0x8d080df5, 0x3b6e20c8, 0x4c69105e, 0xd56041e4,
81 0xa2677172, 0x3c03e4d1, 0x4b04d447, 0xd20d85fd, 0xa50ab56b,
82 0x35b5a8fa, 0x42b2986c, 0xdbbbc9d6, 0xacbcf940, 0x32d86ce3,
83 0x45df5c75, 0xdcd60dcf, 0xabd13d59, 0x26d930ac, 0x51de003a,
84 0xc8d75180, 0xbfd06116, 0x21b4f4b5, 0x56b3c423, 0xcfba9599,
85 0xb8bda50f, 0x2802b89e, 0x5f058808, 0xc60cd9b2, 0xb10be924,
86 0x2f6f7c87, 0x58684c11, 0xc1611dab, 0xb6662d3d, 0x76dc4190,
87 0x01db7106, 0x98d220bc, 0xefd5102a, 0x71b18589, 0x06b6b51f,
88 0x9fbfe4a5, 0xe8b8d433, 0x7807c9a2, 0x0f00f934, 0x9609a88e,
89 0xe10e9818, 0x7f6a0dbb, 0x086d3d2d, 0x91646c97, 0xe6635c01,
90 0x6b6b51f4, 0x1c6c6162, 0x856530d8, 0xf262004e, 0x6c0695ed,
91 0x1b01a57b, 0x8208f4c1, 0xf50fc457, 0x65b0d9c6, 0x12b7e950,
92 0x8bbeb8ea, 0xfcb9887c, 0x62dd1ddf, 0x15da2d49, 0x8cd37cf3,
93 0xfbd44c65, 0x4db26158, 0x3ab551ce, 0xa3bc0074, 0xd4bb30e2,
94 0x4adfa541, 0x3dd895d7, 0xa4d1c46d, 0xd3d6f4fb, 0x4369e96a,
95 0x346ed9fc, 0xad678846, 0xda60b8d0, 0x44042d73, 0x33031de5,
96 0xaa0a4c5f, 0xdd0d7cc9, 0x5005713c, 0x270241aa, 0xbe0b1010,
97 0xc90c2086, 0x5768b525, 0x206f85b3, 0xb966d409, 0xce61e49f,
98 0x5edef90e, 0x29d9c998, 0xb0d09822, 0xc7d7a8b4, 0x59b33d17,
99 0x2eb40d81, 0xb7bd5c3b, 0xc0ba6cad, 0xedb88320, 0x9abfb3b6,
100 0x03b6e20c, 0x74b1d29a, 0xead54739, 0x9dd277af, 0x04db2615,
101 0x73dc1683, 0xe3630b12, 0x94643b84, 0x0d6d6a3e, 0x7a6a5aa8,
102 0xe40ecf0b, 0x9309ff9d, 0x0a00ae27, 0x7d079eb1, 0xf00f9344,
103 0x8708a3d2, 0x1e01f268, 0x6906c2fe, 0xf762575d, 0x806567cb,
104 0x196c3671, 0x6e6b06e7, 0xfed41b76, 0x89d32be0, 0x10da7a5a,
105 0x67dd4acc, 0xf9b9df6f, 0x8ebeeff9, 0x17b7be43, 0x60b08ed5,
106 0xd6d6a3e8, 0xa1d1937e, 0x38d8c2c4, 0x4fdff252, 0xd1bb67f1,
107 0xa6bc5767, 0x3fb506dd, 0x48b2364b, 0xd80d2bda, 0xaf0a1b4c,
108 0x36034af6, 0x41047a60, 0xdf60efc3, 0xa867df55, 0x316e8eef,
109 0x4669be79, 0xcb61b38c, 0xbc66831a, 0x256fd2a0, 0x5268e236,
110 0xcc0c7795, 0xbb0b4703, 0x220216b9, 0x5505262f, 0xc5ba3bbe,
111 0xb2bd0b28, 0x2bb45a92, 0x5cb36a04, 0xc2d7ffa7, 0xb5d0cf31,
112 0x2cd99e8b, 0x5bdeae1d, 0x9b64c2b0, 0xec63f226, 0x756aa39c,
113 0x026d930a, 0x9c0906a9, 0xeb0e363f, 0x72076785, 0x05005713,
114 0x95bf4a82, 0xe2b87a14, 0x7bb12bae, 0x0cb61b38, 0x92d28e9b,
115 0xe5d5be0d, 0x7cdcefb7, 0x0bdbdf21, 0x86d3d2d4, 0xf1d4e242,
116 0x68ddb3f8, 0x1fda836e, 0x81be16cd, 0xf6b9265b, 0x6fb077e1,
117 0x18b74777, 0x88085ae6, 0xff0f6a70, 0x66063bca, 0x11010b5c,
118 0x8f659eff, 0xf862ae69, 0x616bffd3, 0x166ccf45, 0xa00ae278,
119 0xd70dd2ee, 0x4e048354, 0x3903b3c2, 0xa7672661, 0xd06016f7,
120 0x4969474d, 0x3e6e77db, 0xaed16a4a, 0xd9d65adc, 0x40df0b66,
121 0x37d83bf0, 0xa9bcae53, 0xdebb9ec5, 0x47b2cf7f, 0x30b5ffe9,
122 0xbdbdf21c, 0xcabac28a, 0x53b39330, 0x24b4a3a6, 0xbad03605,
123 0xcdd70693, 0x54de5729, 0x23d967bf, 0xb3667a2e, 0xc4614ab8,
124 0x5d681b02, 0x2a6f2b94, 0xb40bbe37, 0xc30c8ea1, 0x5a05df1b,
125 0x2d02ef8d
126};
127
128static u32 partial_crc32_one(u8 c, u32 crc)
129{
130 return crctab32[(crc ^ c) & 0xff] ^ (crc >> 8);
131}
132
133static u32 partial_crc32(const u8 *s, int len, u32 crc)
134{
135 while (len--)
136 crc = partial_crc32_one(*s++, crc);
137 return crc;
138}
139
140static void die(const char * str, ...)
141{
142 va_list args;
143 va_start(args, str);
144 vfprintf(stderr, str, args);
145 va_end(args);
146 fputc('\n', stderr);
147 exit(1);
148}
149
150static void usage(void)
151{
152 die("Usage: build setup system zoffset.h image");
153}
154
155#ifdef CONFIG_EFI_STUB
156
157static void update_pecoff_section_header_fields(char *section_name, u32 vma, u32 size, u32 datasz, u32 offset)
158{
159 unsigned int pe_header;
160 unsigned short num_sections;
161 u8 *section;
162
163 pe_header = get_unaligned_le32(&buf[0x3c]);
164 num_sections = get_unaligned_le16(&buf[pe_header + 6]);
165
166#ifdef CONFIG_X86_32
167 section = &buf[pe_header + 0xa8];
168#else
169 section = &buf[pe_header + 0xb8];
170#endif
171
172 while (num_sections > 0) {
173 if (strncmp((char*)section, section_name, 8) == 0) {
174
175 put_unaligned_le32(size, section + 0x8);
176
177
178 put_unaligned_le32(vma, section + 0xc);
179
180
181 put_unaligned_le32(datasz, section + 0x10);
182
183
184 put_unaligned_le32(offset, section + 0x14);
185
186 break;
187 }
188 section += 0x28;
189 num_sections--;
190 }
191}
192
193static void update_pecoff_section_header(char *section_name, u32 offset, u32 size)
194{
195 update_pecoff_section_header_fields(section_name, offset, size, size, offset);
196}
197
198static void update_pecoff_setup_and_reloc(unsigned int size)
199{
200 u32 setup_offset = 0x200;
201 u32 reloc_offset = size - PECOFF_RELOC_RESERVE - PECOFF_COMPAT_RESERVE;
202#ifdef CONFIG_EFI_MIXED
203 u32 compat_offset = reloc_offset + PECOFF_RELOC_RESERVE;
204#endif
205 u32 setup_size = reloc_offset - setup_offset;
206
207 update_pecoff_section_header(".setup", setup_offset, setup_size);
208 update_pecoff_section_header(".reloc", reloc_offset, PECOFF_RELOC_RESERVE);
209
210
211
212
213
214 put_unaligned_le32(reloc_offset + 10, &buf[reloc_offset]);
215 put_unaligned_le32(10, &buf[reloc_offset + 4]);
216
217#ifdef CONFIG_EFI_MIXED
218 update_pecoff_section_header(".compat", compat_offset, PECOFF_COMPAT_RESERVE);
219
220
221
222
223
224
225 buf[compat_offset] = 0x1;
226 buf[compat_offset + 1] = 0x8;
227 put_unaligned_le16(0x14c, &buf[compat_offset + 2]);
228 put_unaligned_le32(efi32_pe_entry + size, &buf[compat_offset + 4]);
229#endif
230}
231
232static void update_pecoff_text(unsigned int text_start, unsigned int file_sz,
233 unsigned int init_sz)
234{
235 unsigned int pe_header;
236 unsigned int text_sz = file_sz - text_start;
237 unsigned int bss_sz = init_sz - file_sz;
238
239 pe_header = get_unaligned_le32(&buf[0x3c]);
240
241
242
243
244
245
246
247
248
249
250 bss_sz += CONFIG_PHYSICAL_ALIGN;
251 init_sz += CONFIG_PHYSICAL_ALIGN;
252
253
254
255
256
257 put_unaligned_le32(file_sz - 512 + bss_sz, &buf[pe_header + 0x1c]);
258
259
260 put_unaligned_le32(init_sz, &buf[pe_header + 0x50]);
261
262
263
264
265 put_unaligned_le32(text_start + efi_pe_entry, &buf[pe_header + 0x28]);
266
267 update_pecoff_section_header_fields(".text", text_start, text_sz + bss_sz,
268 text_sz, text_start);
269}
270
271static int reserve_pecoff_reloc_section(int c)
272{
273
274 memset(buf+c, 0, PECOFF_RELOC_RESERVE);
275 return PECOFF_RELOC_RESERVE;
276}
277
278static void efi_stub_defaults(void)
279{
280
281#ifdef CONFIG_X86_32
282 efi_pe_entry = 0x10;
283#else
284 efi_pe_entry = 0x210;
285 startup_64 = 0x200;
286#endif
287}
288
289static void efi_stub_entry_update(void)
290{
291 unsigned long addr = efi32_stub_entry;
292
293#ifdef CONFIG_X86_64
294
295 addr = efi64_stub_entry - 0x200;
296#endif
297
298#ifdef CONFIG_EFI_MIXED
299 if (efi32_stub_entry != addr)
300 die("32-bit and 64-bit EFI entry points do not match\n");
301#endif
302 put_unaligned_le32(addr, &buf[0x264]);
303}
304
305#else
306
307static inline void update_pecoff_setup_and_reloc(unsigned int size) {}
308static inline void update_pecoff_text(unsigned int text_start,
309 unsigned int file_sz,
310 unsigned int init_sz) {}
311static inline void efi_stub_defaults(void) {}
312static inline void efi_stub_entry_update(void) {}
313
314static inline int reserve_pecoff_reloc_section(int c)
315{
316 return 0;
317}
318#endif
319
320static int reserve_pecoff_compat_section(int c)
321{
322
323 memset(buf+c, 0, PECOFF_COMPAT_RESERVE);
324 return PECOFF_COMPAT_RESERVE;
325}
326
327
328
329
330
331
332#define PARSE_ZOFS(p, sym) do { \
333 if (!strncmp(p, "#define ZO_" #sym " ", 11+sizeof(#sym))) \
334 sym = strtoul(p + 11 + sizeof(#sym), NULL, 16); \
335} while (0)
336
337static void parse_zoffset(char *fname)
338{
339 FILE *file;
340 char *p;
341 int c;
342
343 file = fopen(fname, "r");
344 if (!file)
345 die("Unable to open `%s': %m", fname);
346 c = fread(buf, 1, sizeof(buf) - 1, file);
347 if (ferror(file))
348 die("read-error on `zoffset.h'");
349 fclose(file);
350 buf[c] = 0;
351
352 p = (char *)buf;
353
354 while (p && *p) {
355 PARSE_ZOFS(p, efi32_stub_entry);
356 PARSE_ZOFS(p, efi64_stub_entry);
357 PARSE_ZOFS(p, efi_pe_entry);
358 PARSE_ZOFS(p, efi32_pe_entry);
359 PARSE_ZOFS(p, kernel_info);
360 PARSE_ZOFS(p, startup_64);
361 PARSE_ZOFS(p, _ehead);
362 PARSE_ZOFS(p, _end);
363
364 p = strchr(p, '\n');
365 while (p && (*p == '\r' || *p == '\n'))
366 p++;
367 }
368}
369
370int main(int argc, char ** argv)
371{
372 unsigned int i, sz, setup_sectors, init_sz;
373 int c;
374 u32 sys_size;
375 struct stat sb;
376 FILE *file, *dest;
377 int fd;
378 void *kernel;
379 u32 crc = 0xffffffffUL;
380
381 efi_stub_defaults();
382
383 if (argc != 5)
384 usage();
385 parse_zoffset(argv[3]);
386
387 dest = fopen(argv[4], "w");
388 if (!dest)
389 die("Unable to write `%s': %m", argv[4]);
390
391
392 file = fopen(argv[1], "r");
393 if (!file)
394 die("Unable to open `%s': %m", argv[1]);
395 c = fread(buf, 1, sizeof(buf), file);
396 if (ferror(file))
397 die("read-error on `setup'");
398 if (c < 1024)
399 die("The setup must be at least 1024 bytes");
400 if (get_unaligned_le16(&buf[510]) != 0xAA55)
401 die("Boot block hasn't got boot flag (0xAA55)");
402 fclose(file);
403
404 c += reserve_pecoff_compat_section(c);
405 c += reserve_pecoff_reloc_section(c);
406
407
408 setup_sectors = (c + 511) / 512;
409 if (setup_sectors < SETUP_SECT_MIN)
410 setup_sectors = SETUP_SECT_MIN;
411 i = setup_sectors*512;
412 memset(buf+c, 0, i-c);
413
414 update_pecoff_setup_and_reloc(i);
415
416
417 put_unaligned_le16(DEFAULT_ROOT_DEV, &buf[508]);
418
419
420 fd = open(argv[2], O_RDONLY);
421 if (fd < 0)
422 die("Unable to open `%s': %m", argv[2]);
423 if (fstat(fd, &sb))
424 die("Unable to stat `%s': %m", argv[2]);
425 sz = sb.st_size;
426 kernel = mmap(NULL, sz, PROT_READ, MAP_SHARED, fd, 0);
427 if (kernel == MAP_FAILED)
428 die("Unable to mmap '%s': %m", argv[2]);
429
430 sys_size = (sz + 15 + 4) / 16;
431#ifdef CONFIG_EFI_STUB
432
433
434
435
436 sys_size = (sys_size + 1) & ~1;
437#endif
438
439
440 buf[0x1f1] = setup_sectors-1;
441 put_unaligned_le32(sys_size, &buf[0x1f4]);
442
443 init_sz = get_unaligned_le32(&buf[0x260]);
444#ifdef CONFIG_EFI_STUB
445
446
447
448
449
450
451
452
453
454
455
456
457
458
459 if (init_sz - _end < i + _ehead) {
460 init_sz = (i + _ehead + _end + 4095) & ~4095;
461 put_unaligned_le32(init_sz, &buf[0x260]);
462 }
463#endif
464 update_pecoff_text(setup_sectors * 512, i + (sys_size * 16), init_sz);
465
466 efi_stub_entry_update();
467
468
469 put_unaligned_le32(kernel_info, &buf[0x268]);
470
471 crc = partial_crc32(buf, i, crc);
472 if (fwrite(buf, 1, i, dest) != i)
473 die("Writing setup failed");
474
475
476 crc = partial_crc32(kernel, sz, crc);
477 if (fwrite(kernel, 1, sz, dest) != sz)
478 die("Writing kernel failed");
479
480
481 while (sz++ < (sys_size*16) - 4) {
482 crc = partial_crc32_one('\0', crc);
483 if (fwrite("\0", 1, 1, dest) != 1)
484 die("Writing padding failed");
485 }
486
487
488 put_unaligned_le32(crc, buf);
489 if (fwrite(buf, 1, 4, dest) != 4)
490 die("Writing CRC failed");
491
492
493 if (fclose(dest))
494 die("Writing image failed");
495
496 close(fd);
497
498
499 return 0;
500}
501