wok-6.x annotate syslinux/stuff/extra/md5sum.c @ rev 18677

syslinux/c32box: fix custom initrd >= 2k
author Pascal Bellard <pascal.bellard@slitaz.org>
date Sun Dec 06 17:41:24 2015 +0100 (2015-12-06)
parents 1e69cfd7f652
children 924e6ea5da10
rev   line source
pascal@12210 1 /*
pascal@12215 2 * Based on busybox code.
pascal@12210 3 *
pascal@12215 4 * Compute MD5 checksum of strings according to the
pascal@12215 5 * definition of MD5 in RFC 1321 from April 1992.
pascal@12210 6 *
pascal@12215 7 * Written by Ulrich Drepper <drepper@gnu.ai.mit.edu>, 1995.
pascal@12215 8 *
pascal@12215 9 * Copyright (C) 1995-1999 Free Software Foundation, Inc.
pascal@12215 10 * Copyright (C) 2001 Manuel Novoa III
pascal@12215 11 * Copyright (C) 2003 Glenn L. McGrath
pascal@12215 12 * Copyright (C) 2003 Erik Andersen
pascal@12210 13 * Copyright (C) 2010 Denys Vlasenko
pascal@12215 14 * Copyright (C) 2012 Pascal Bellard
pascal@12210 15 *
pascal@12215 16 * Licensed under GPLv2 or later
pascal@12210 17 */
pascal@12210 18
pascal@12210 19 #include <stdio.h>
pascal@12210 20 #include <stdlib.h>
pascal@12210 21 #include <string.h>
pascal@12210 22 #include <unistd.h>
pascal@12210 23 #include <fcntl.h>
pascal@12210 24 #include <console.h>
pascal@12210 25 #include <com32.h>
pascal@18674 26 #include <syslinux/config.h>
pascal@18674 27 #include <syslinux/disk.h>
pascal@12210 28
pascal@12210 29 #define ALIGN1
pascal@12215 30
pascal@12215 31 static uint8_t wbuffer[64]; /* always correctly aligned for uint64_t */
pascal@12215 32 static uint64_t total64; /* must be directly before hash[] */
pascal@12215 33 static uint32_t hash[8]; /* 4 elements for md5, 5 for sha1, 8 for sha256 */
pascal@12210 34
pascal@12210 35 /* Emit a string of hex representation of bytes */
pascal@12215 36 static char* bin2hex(char *p)
pascal@12210 37 {
pascal@12215 38 static const char bb_hexdigits_upcase[] ALIGN1 = "0123456789abcdef";
pascal@12215 39 int count = 16;
pascal@12215 40 const char *cp = (const char *) hash;
pascal@12210 41 while (count) {
pascal@12210 42 unsigned char c = *cp++;
pascal@12210 43 /* put lowercase hex digits */
pascal@12215 44 *p++ = bb_hexdigits_upcase[c >> 4];
pascal@12215 45 *p++ = bb_hexdigits_upcase[c & 0xf];
pascal@12210 46 count--;
pascal@12210 47 }
pascal@12210 48 return p;
pascal@12210 49 }
pascal@12210 50
pascal@12210 51 //#define rotl32(x,n) (((x) << (n)) | ((x) >> (32 - (n))))
pascal@12210 52 static uint32_t rotl32(uint32_t x, unsigned n)
pascal@12210 53 {
pascal@12210 54 return (x << n) | (x >> (32 - n));
pascal@12210 55 }
pascal@12210 56
pascal@12215 57 static void md5_process_block64(void);
pascal@12210 58
pascal@12210 59 /* Feed data through a temporary buffer.
pascal@12210 60 * The internal buffer remembers previous data until it has 64
pascal@12210 61 * bytes worth to pass on.
pascal@12210 62 */
pascal@12215 63 static void common64_hash(const void *buffer, size_t len)
pascal@12210 64 {
pascal@12215 65 unsigned bufpos = total64 & 63;
pascal@12210 66
pascal@12215 67 total64 += len;
pascal@12210 68
pascal@12210 69 while (1) {
pascal@12210 70 unsigned remaining = 64 - bufpos;
pascal@12210 71 if (remaining > len)
pascal@12210 72 remaining = len;
pascal@12210 73 /* Copy data into aligned buffer */
pascal@12215 74 memcpy(wbuffer + bufpos, buffer, remaining);
pascal@12210 75 len -= remaining;
pascal@12210 76 buffer = (const char *)buffer + remaining;
pascal@12210 77 bufpos += remaining;
pascal@12210 78 /* clever way to do "if (bufpos != 64) break; ... ; bufpos = 0;" */
pascal@12210 79 bufpos -= 64;
pascal@12210 80 if (bufpos != 0)
pascal@12210 81 break;
pascal@12210 82 /* Buffer is filled up, process it */
pascal@12215 83 md5_process_block64();
pascal@12210 84 /*bufpos = 0; - already is */
pascal@12210 85 }
pascal@12210 86 }
pascal@12210 87
pascal@12210 88 /* Process the remaining bytes in the buffer */
pascal@12215 89 static void common64_end(void)
pascal@12210 90 {
pascal@12215 91 unsigned bufpos = total64 & 63;
pascal@12210 92 /* Pad the buffer to the next 64-byte boundary with 0x80,0,0,0... */
pascal@12215 93 wbuffer[bufpos++] = 0x80;
pascal@12210 94
pascal@12210 95 /* This loop iterates either once or twice, no more, no less */
pascal@12210 96 while (1) {
pascal@12210 97 unsigned remaining = 64 - bufpos;
pascal@12215 98 memset(wbuffer + bufpos, 0, remaining);
pascal@12210 99 /* Do we have enough space for the length count? */
pascal@12210 100 if (remaining >= 8) {
pascal@12210 101 /* Store the 64-bit counter of bits in the buffer */
pascal@12215 102 uint64_t t = total64 << 3;
pascal@12210 103 /* wbuffer is suitably aligned for this */
pascal@12215 104 *(uint64_t *) (&wbuffer[64 - 8]) = t;
pascal@12210 105 }
pascal@12215 106 md5_process_block64();
pascal@12210 107 if (remaining >= 8)
pascal@12210 108 break;
pascal@12210 109 bufpos = 0;
pascal@12210 110 }
pascal@12210 111 }
pascal@12210 112
pascal@12210 113 /* These are the four functions used in the four steps of the MD5 algorithm
pascal@12210 114 * and defined in the RFC 1321. The first function is a little bit optimized
pascal@12210 115 * (as found in Colin Plumbs public domain implementation).
pascal@12210 116 * #define FF(b, c, d) ((b & c) | (~b & d))
pascal@12210 117 */
pascal@12210 118 #undef FF
pascal@12210 119 #undef FG
pascal@12210 120 #undef FH
pascal@12210 121 #undef FI
pascal@12210 122 #define FF(b, c, d) (d ^ (b & (c ^ d)))
pascal@12210 123 #define FG(b, c, d) FF(d, b, c)
pascal@12210 124 #define FH(b, c, d) (b ^ c ^ d)
pascal@12210 125 #define FI(b, c, d) (c ^ (b | ~d))
pascal@12210 126
pascal@12210 127 /* Hash a single block, 64 bytes long and 4-byte aligned */
pascal@12215 128 static void md5_process_block64(void)
pascal@12210 129 {
pascal@12210 130 /* Before we start, one word to the strange constants.
pascal@12210 131 They are defined in RFC 1321 as
pascal@12210 132 T[i] = (int)(4294967296.0 * fabs(sin(i))), i=1..64
pascal@12210 133 */
pascal@12210 134 static const uint32_t C_array[] = {
pascal@12210 135 /* round 1 */
pascal@12210 136 0xd76aa478, 0xe8c7b756, 0x242070db, 0xc1bdceee,
pascal@12210 137 0xf57c0faf, 0x4787c62a, 0xa8304613, 0xfd469501,
pascal@12210 138 0x698098d8, 0x8b44f7af, 0xffff5bb1, 0x895cd7be,
pascal@12210 139 0x6b901122, 0xfd987193, 0xa679438e, 0x49b40821,
pascal@12210 140 /* round 2 */
pascal@12210 141 0xf61e2562, 0xc040b340, 0x265e5a51, 0xe9b6c7aa,
pascal@12210 142 0xd62f105d, 0x02441453, 0xd8a1e681, 0xe7d3fbc8,
pascal@12210 143 0x21e1cde6, 0xc33707d6, 0xf4d50d87, 0x455a14ed,
pascal@12210 144 0xa9e3e905, 0xfcefa3f8, 0x676f02d9, 0x8d2a4c8a,
pascal@12210 145 /* round 3 */
pascal@12210 146 0xfffa3942, 0x8771f681, 0x6d9d6122, 0xfde5380c,
pascal@12210 147 0xa4beea44, 0x4bdecfa9, 0xf6bb4b60, 0xbebfbc70,
pascal@12210 148 0x289b7ec6, 0xeaa127fa, 0xd4ef3085, 0x4881d05,
pascal@12210 149 0xd9d4d039, 0xe6db99e5, 0x1fa27cf8, 0xc4ac5665,
pascal@12210 150 /* round 4 */
pascal@12210 151 0xf4292244, 0x432aff97, 0xab9423a7, 0xfc93a039,
pascal@12210 152 0x655b59c3, 0x8f0ccc92, 0xffeff47d, 0x85845dd1,
pascal@12210 153 0x6fa87e4f, 0xfe2ce6e0, 0xa3014314, 0x4e0811a1,
pascal@12210 154 0xf7537e82, 0xbd3af235, 0x2ad7d2bb, 0xeb86d391
pascal@12210 155 };
pascal@12210 156 static const char P_array[] ALIGN1 = {
pascal@12210 157 0, 1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14, 15, /* 1 */
pascal@12210 158 1, 6, 11, 0, 5, 10, 15, 4, 9, 14, 3, 8, 13, 2, 7, 12, /* 2 */
pascal@12210 159 5, 8, 11, 14, 1, 4, 7, 10, 13, 0, 3, 6, 9, 12, 15, 2, /* 3 */
pascal@12210 160 0, 7, 14, 5, 12, 3, 10, 1, 8, 15, 6, 13, 4, 11, 2, 9 /* 4 */
pascal@12210 161 };
pascal@12215 162 uint32_t *words = (void*) wbuffer;
pascal@12215 163 uint32_t A = hash[0];
pascal@12215 164 uint32_t B = hash[1];
pascal@12215 165 uint32_t C = hash[2];
pascal@12215 166 uint32_t D = hash[3];
pascal@12210 167
pascal@12210 168 static const char S_array[] ALIGN1 = {
pascal@12210 169 7, 12, 17, 22,
pascal@12210 170 5, 9, 14, 20,
pascal@12210 171 4, 11, 16, 23,
pascal@12210 172 6, 10, 15, 21
pascal@12210 173 };
pascal@12210 174 const uint32_t *pc;
pascal@12210 175 const char *pp;
pascal@12210 176 const char *ps;
pascal@12210 177 int i;
pascal@12210 178 uint32_t temp;
pascal@12210 179
pascal@12210 180
pascal@12210 181 pc = C_array;
pascal@12210 182 pp = P_array;
pascal@12210 183 ps = S_array - 4;
pascal@12210 184
pascal@12210 185 for (i = 0; i < 64; i++) {
pascal@12210 186 if ((i & 0x0f) == 0)
pascal@12210 187 ps += 4;
pascal@12210 188 temp = A;
pascal@12210 189 switch (i >> 4) {
pascal@12210 190 case 0:
pascal@12210 191 temp += FF(B, C, D);
pascal@12210 192 break;
pascal@12210 193 case 1:
pascal@12210 194 temp += FG(B, C, D);
pascal@12210 195 break;
pascal@12210 196 case 2:
pascal@12210 197 temp += FH(B, C, D);
pascal@12210 198 break;
pascal@12210 199 case 3:
pascal@12210 200 temp += FI(B, C, D);
pascal@12210 201 }
pascal@12210 202 temp += words[(int) (*pp++)] + *pc++;
pascal@12210 203 temp = rotl32(temp, ps[i & 3]);
pascal@12210 204 temp += B;
pascal@12210 205 A = D;
pascal@12210 206 D = C;
pascal@12210 207 C = B;
pascal@12210 208 B = temp;
pascal@12210 209 }
pascal@12210 210 /* Add checksum to the starting values */
pascal@12215 211 hash[0] += A;
pascal@12215 212 hash[1] += B;
pascal@12215 213 hash[2] += C;
pascal@12215 214 hash[3] += D;
pascal@12210 215
pascal@12210 216 }
pascal@12210 217 #undef FF
pascal@12210 218 #undef FG
pascal@12210 219 #undef FH
pascal@12210 220 #undef FI
pascal@12210 221
pascal@12210 222 /* Initialize structure containing state of computation.
pascal@12210 223 * (RFC 1321, 3.3: Step 3)
pascal@12210 224 */
pascal@12215 225 static void md5_begin(void)
pascal@12210 226 {
pascal@12215 227 hash[0] = 0x67452301;
pascal@12215 228 hash[1] = 0xefcdab89;
pascal@12215 229 hash[2] = 0x98badcfe;
pascal@12215 230 hash[3] = 0x10325476;
pascal@12215 231 total64 = 0;
pascal@12210 232 }
pascal@12210 233
pascal@12210 234 /* Used also for sha1 and sha256 */
pascal@12215 235 #define md5_hash common64_hash
pascal@12210 236
pascal@12210 237 /* Process the remaining bytes in the buffer and put result from CTX
pascal@12210 238 * in first 16 bytes following RESBUF. The result is always in little
pascal@12210 239 * endian byte order, so that a byte-wise output yields to the wanted
pascal@12210 240 * ASCII representation of the message digest.
pascal@12210 241 */
pascal@12215 242 #define md5_end common64_end
pascal@12210 243
pascal@12210 244 /*
pascal@12210 245 * Copyright (C) 2003 Glenn L. McGrath
pascal@12210 246 * Copyright (C) 2003-2004 Erik Andersen
pascal@12210 247 *
pascal@12210 248 * Licensed under GPLv2 or later, see file LICENSE in this source tree.
pascal@12210 249 */
pascal@12210 250
pascal@12215 251 static char *unrockridge(const char *name)
pascal@12212 252 {
pascal@12212 253 static char buffer[256];
pascal@12215 254 int i = 0, j = 8;
pascal@12215 255 while (*name && i < 255) {
pascal@12215 256 char c = *name++;
pascal@12215 257 //if (c == '\\') c = '/';
pascal@12215 258 if (c == '.') {
pascal@12215 259 for (j = i; --j >= 0 && buffer[j] != '/';)
pascal@12215 260 if (buffer[j] == '.') buffer[j] = '_';
pascal@12215 261 if (i - j > 9) i = j + 9;
pascal@12215 262 j = i + 4;
pascal@12212 263 }
pascal@12215 264 else if (c == '/') j = i + 9;
pascal@12212 265 else if (i >= j) continue;
pascal@12215 266 else if (c >= 'a' && c <= 'z') c += 'A' - 'a';
pascal@12215 267 else if ((c < 'A' || c > 'Z') && (c < '0' || c > '9')) c = '_';
pascal@12215 268 buffer[i++] = c;
pascal@12212 269 }
pascal@12215 270 buffer[i] = 0;
pascal@12212 271 return buffer;
pascal@12212 272 }
pascal@12212 273
pascal@12210 274 static uint8_t *hash_file(const char *filename)
pascal@12210 275 {
pascal@12210 276 int src_fd, count;
pascal@12215 277 uint8_t in_buf[4096];
pascal@12215 278 static uint8_t hash_value[16*2+1];
pascal@12210 279
pascal@12210 280 src_fd = open(filename, O_RDONLY);
pascal@12210 281 if (src_fd < 0) {
pascal@12215 282 src_fd = open(unrockridge(filename), O_RDONLY);
pascal@12212 283 }
pascal@12212 284 if (src_fd < 0) {
pascal@12210 285 return NULL;
pascal@12210 286 }
pascal@12210 287
pascal@12215 288 md5_begin();
pascal@12210 289 while ((count = read(src_fd, in_buf, 4096)) > 0) {
pascal@12215 290 md5_hash(in_buf, count);
pascal@12210 291 }
pascal@12210 292
pascal@12210 293 close(src_fd);
pascal@12215 294
pascal@12215 295 if (count)
pascal@12215 296 return NULL;
pascal@12215 297
pascal@12215 298 md5_end();
pascal@12215 299 bin2hex((char *)hash_value);
pascal@12210 300
pascal@12210 301 return hash_value;
pascal@12210 302 }
pascal@12210 303
pascal@13295 304 static int main_say(int argc, char **argv)
pascal@13295 305 {
pascal@13295 306 int i;
pascal@13295 307 for (i = 1; i < argc; i++) {
pascal@13295 308 printf("%s ",argv[i]);
pascal@13295 309 }
pascal@13295 310 sleep(5);
pascal@13551 311 return 0;
pascal@13295 312 }
pascal@13295 313
pascal@12273 314 static int main_md5sum(int argc, char **argv)
pascal@12210 315 {
pascal@12215 316 int files = 0, tested = 0, good = 0;
pascal@12215 317 static char clear_eol[] = " ";
pascal@12210 318
pascal@12210 319 (void) argc;
pascal@12210 320 /* -c implied */
pascal@12287 321 argv++;
pascal@12210 322 do {
pascal@12210 323 FILE *fp;
pascal@13361 324 char eol, *line, buffer[4096];
pascal@12210 325 fp = fopen(*argv,"r");
pascal@12212 326 if (fp == NULL)
pascal@12215 327 fp = fopen(unrockridge(*argv),"r");
pascal@12210 328
pascal@13361 329 while ((line = fgets(buffer,sizeof(buffer),fp)) != NULL) {
pascal@12210 330 uint8_t *hash_value;
pascal@12210 331 char *filename_ptr, *status;
pascal@12210 332 int len = strlen(line);
pascal@12210 333
pascal@12210 334 if (line[0] < '0')
pascal@12210 335 continue;
pascal@12210 336 if (line[len-1] == '\n')
pascal@12210 337 line[len-1] = 0;
pascal@12210 338 filename_ptr = strstr(line, " ");
pascal@12210 339 /* handle format for binary checksums */
pascal@12210 340 if (filename_ptr == NULL) {
pascal@12210 341 filename_ptr = strstr(line, " *");
pascal@12210 342 }
pascal@12210 343 if (filename_ptr == NULL) {
pascal@12210 344 continue;
pascal@12210 345 }
pascal@12210 346 *filename_ptr = '\0';
pascal@12210 347 *++filename_ptr = '/';
pascal@12212 348 if (filename_ptr[1] == '/')
pascal@12212 349 filename_ptr++;
pascal@12210 350
pascal@12215 351 files++;
pascal@12215 352 status = "NOT CHECKED";
pascal@12215 353 eol = '\n';
pascal@12211 354 hash_value = hash_file(filename_ptr);
pascal@12211 355 if (hash_value) {
pascal@12215 356 tested++;
pascal@12215 357 status = "BROKEN";
pascal@12215 358 if (!strcmp((char*)hash_value, line)) {
pascal@12215 359 good++;
pascal@12215 360 status = "OK";
pascal@12215 361 eol = ' ';
pascal@12210 362 }
pascal@12210 363 }
pascal@12215 364 printf("\r%s: %s%s%c", filename_ptr, status, clear_eol, eol);
pascal@12210 365 }
pascal@12210 366 fclose(fp);
pascal@12210 367 } while (*++argv);
pascal@12215 368 printf("\r%d files OK, %d broken, %d not checked.%s\n",
pascal@12215 369 good, tested - good, files - tested, clear_eol);
pascal@12287 370 sleep(5);
pascal@12273 371 return 0;
pascal@12215 372 }
pascal@12210 373
pascal@12273 374 /*
pascal@12273 375 * ifmem.c
pascal@12273 376 *
pascal@12273 377 * Run one command if the memory is large enought, and another if it isn't.
pascal@12273 378 *
pascal@12273 379 * Usage:
pascal@12273 380 *
pascal@12273 381 * label boot_kernel
pascal@12273 382 * kernel ifmem.c
pascal@12273 383 * append size_in_KB boot_large [size_in_KB boot_medium] boot_small
pascal@12273 384 *
pascal@12273 385 * label boot_large
pascal@12273 386 * kernel vmlinuz_large_memory
pascal@12273 387 * append ...
pascal@12273 388 *
pascal@12273 389 * label boot_small
pascal@12273 390 * kernel vmlinuz_small_memory
pascal@12273 391 * append ...
pascal@12273 392 */
pascal@12273 393
pascal@12273 394 #include <inttypes.h>
pascal@12273 395 #include <alloca.h>
pascal@12273 396 #include <syslinux/boot.h>
pascal@12273 397
pascal@12273 398 struct e820_data {
pascal@12273 399 uint64_t base;
pascal@12273 400 uint64_t len;
pascal@12273 401 uint32_t type;
pascal@12273 402 uint32_t extattr;
pascal@12273 403 } __attribute__((packed));
pascal@12273 404
pascal@12273 405 // Get memory size in Kb
pascal@12273 406 static unsigned long memory_size(void)
pascal@12273 407 {
pascal@12273 408 uint64_t bytes = 0;
pascal@12273 409 static com32sys_t ireg, oreg;
pascal@12273 410 static struct e820_data ed;
pascal@12273 411
pascal@12273 412 ireg.eax.w[0] = 0xe820;
pascal@12273 413 ireg.edx.l = 0x534d4150;
pascal@12273 414 ireg.ecx.l = sizeof(struct e820_data);
pascal@12273 415 ireg.edi.w[0] = OFFS(__com32.cs_bounce);
pascal@12273 416 ireg.es = SEG(__com32.cs_bounce);
pascal@12273 417
pascal@12273 418 ed.extattr = 1;
pascal@12273 419
pascal@12273 420 do {
pascal@12273 421 memcpy(__com32.cs_bounce, &ed, sizeof ed);
pascal@12273 422
pascal@12273 423 __intcall(0x15, &ireg, &oreg);
pascal@12273 424 if (oreg.eflags.l & EFLAGS_CF ||
pascal@12273 425 oreg.eax.l != 0x534d4150 ||
pascal@12273 426 oreg.ecx.l < 20)
pascal@12273 427 break;
pascal@12273 428
pascal@12273 429 memcpy(&ed, __com32.cs_bounce, sizeof ed);
pascal@12273 430
pascal@12273 431 if (ed.type == 1)
pascal@12273 432 bytes += ed.len;
pascal@12273 433
pascal@12273 434 ireg.ebx.l = oreg.ebx.l;
pascal@12273 435 } while (ireg.ebx.l);
pascal@12273 436
pascal@12273 437 if (!bytes) {
pascal@12273 438 memset(&ireg, 0, sizeof ireg);
pascal@12273 439 ireg.eax.w[0] = 0x8800;
pascal@12273 440 __intcall(0x15, &ireg, &oreg);
pascal@12273 441 return ireg.eax.w[0];
pascal@12273 442 }
pascal@12273 443 return bytes >> 10;
pascal@12273 444 }
pascal@12273 445
pascal@12349 446 static void usage(const char *msg)
pascal@12349 447 {
pascal@12349 448 fprintf(stderr,"\n%s\n.",msg);
pascal@12349 449 sleep(5);
pascal@12349 450 exit(1);
pascal@12349 451 }
pascal@12349 452
pascal@12273 453 static int main_ifmem(int argc, char *argv[])
pascal@12273 454 {
pascal@12273 455 int i;
pascal@12273 456 unsigned long ram_size;
pascal@12273 457
pascal@12273 458 if (argc < 4) {
pascal@12349 459 usage("Usage: ifmem.c32 size_KB boot_large_memory boot_small_memory");
pascal@12273 460 }
pascal@12273 461
pascal@12273 462 // find target according to ram size
pascal@12273 463 ram_size = memory_size();
pascal@12273 464 printf("Total memory found %luK.\n",ram_size);
pascal@12273 465 ram_size += (1 << 10); // add 1M to round boundaries...
pascal@12273 466
pascal@12273 467 i = 1;
pascal@12273 468 do {
pascal@12273 469 char *s = argv[i];
pascal@12273 470 char *p = s;
pascal@12273 471 unsigned long scale = 1;
pascal@12273 472
pascal@12273 473 while (*p >= '0' && *p <= '9') p++;
pascal@12273 474 switch (*p | 0x20) {
pascal@12273 475 case 'g': scale <<= 10;
pascal@12273 476 case 'm': scale <<= 10;
pascal@12273 477 default : *p = 0; break;
pascal@12273 478 }
pascal@12273 479 i++; // seek to label
pascal@12273 480 if (ram_size >= scale * strtoul(s, NULL, 0)) break;
pascal@12273 481 i++; // next size or default label
pascal@12273 482 } while (i + 1 < argc);
pascal@12273 483
pascal@12349 484 if (i != argc) syslinux_run_command(argv[i]);
pascal@12273 485 else syslinux_run_default();
pascal@12273 486 return -1;
pascal@12273 487 }
pascal@12273 488
pascal@12273 489 #include <syslinux/reboot.h>
pascal@12273 490
pascal@12273 491 static int main_reboot(int argc, char *argv[])
pascal@12273 492 {
pascal@12273 493 int warm = 0;
pascal@12273 494 int i;
pascal@12273 495
pascal@12273 496 for (i = 1; i < argc; i++) {
pascal@12273 497 if (!strcmp(argv[i], "-w") || !strcmp(argv[i], "--warm"))
pascal@12273 498 warm = 1;
pascal@12273 499 }
pascal@12273 500
pascal@12273 501 syslinux_reboot(warm);
pascal@12273 502 }
pascal@12273 503
pascal@12273 504 /* APM poweroff module.
pascal@12273 505 * based on poweroff.asm, Copyright 2009 Sebastian Herbszt
pascal@12273 506 */
pascal@12273 507
pascal@12273 508 static int main_poweroff(int argc, char *argv[])
pascal@12273 509 {
pascal@12273 510 static com32sys_t ireg, oreg;
pascal@12273 511 static char notsupported[] ="APM 1.1+ not supported";
pascal@12273 512 unsigned i;
pascal@12273 513 static struct {
pascal@12273 514 unsigned short ax;
pascal@12273 515 unsigned short bx;
pascal@12273 516 unsigned short cx;
pascal@12273 517 char *msg;
pascal@12273 518 } inst[] = {
pascal@12273 519 { 0x5300, // APM Installation Check (00h)
pascal@12273 520 0, // APM BIOS (0000h)
pascal@12273 521 0, "APM not present" },
pascal@12273 522 { 0x5301, // APM Real Mode Interface Connect (01h)
pascal@12273 523 0, // APM BIOS (0000h)
pascal@12273 524 0, "APM RM interface connect failed" },
pascal@12273 525 { 0x530E, // APM Driver Version (0Eh)
pascal@12273 526 0, // APM BIOS (0000h)
pascal@12273 527 0x0101, // APM Driver Version version 1.1
pascal@12273 528 notsupported },
pascal@12273 529 { 0x5307, // Set Power State (07h)
pascal@12273 530 1, // All devices power managed by the APM
pascal@12273 531 3, // Power state off
pascal@12273 532 "Power off failed" }
pascal@12273 533 };
pascal@12273 534
pascal@12273 535 (void) argc;
pascal@12273 536 (void) argv;
pascal@12273 537 for (i = 0; i < sizeof(inst)/sizeof(inst[0]); i++) {
pascal@12273 538 char *msg = inst[i].msg;
pascal@12273 539
pascal@12273 540 ireg.eax.w[0] = inst[i].ax;
pascal@12273 541 ireg.ebx.w[0] = inst[i].bx;
pascal@12273 542 ireg.ecx.w[0] = inst[i].cx;
pascal@12273 543 __intcall(0x15, &ireg, &oreg);
pascal@12273 544 if ((oreg.eflags.l & EFLAGS_CF) == 0) {
pascal@12273 545 switch (inst[i].ax) {
pascal@12273 546 case 0x5300 :
pascal@12273 547 if (oreg.ebx.w[0] != 0x504D /* 'PM' */) break;
pascal@12273 548 msg = "Power management disabled";
pascal@12273 549 if (oreg.ecx.w[0] & 8) break; // bit 3 APM BIOS Power Management disabled
pascal@12273 550 case 0x530E :
pascal@12273 551 msg = notsupported;
pascal@12273 552 if (oreg.eax.w[0] < 0x101) break;
pascal@12273 553 default : continue;
pascal@12273 554 }
pascal@12273 555 }
pascal@12273 556 printf("%s.\n", msg);
pascal@12273 557 return 1;
pascal@12273 558 }
pascal@12273 559 return 0;
pascal@12273 560 }
pascal@12273 561
pascal@12287 562 /*
pascal@12287 563 * Copyright 2009 Intel Corporation; author: H. Peter Anvin
pascal@12287 564 */
pascal@12287 565
pascal@12287 566 #include <syslinux/keyboard.h>
pascal@12287 567 #include <syslinux/loadfile.h>
pascal@12287 568 #include <syslinux/adv.h>
pascal@12287 569
pascal@12349 570 static void setlinuxarg(int slot, int argc, char *argv[])
pascal@12349 571 {
pascal@12349 572 for (; argc--; argv++)
pascal@12349 573 syslinux_setadv(slot++, strlen(*argv), *argv);
pascal@12349 574 }
pascal@12349 575
pascal@12287 576 static int main_kbdmap(int argc, char *argv[])
pascal@12287 577 {
pascal@12287 578 const struct syslinux_keyboard_map *const kmap = syslinux_keyboard_map();
pascal@12287 579 size_t map_size, size, i;
pascal@12287 580 char *kbdmap, *msg;
pascal@12287 581
pascal@12287 582 if (argc < 3)
pascal@12349 583 usage("Usage: kbdmap archive.cpio mapfile [cmdline]..");
pascal@12287 584
pascal@12293 585 // Save extra cmdline arguments
pascal@12349 586 setlinuxarg(1, argc - 3, argv + 3);
pascal@12293 587
pascal@13318 588 msg="Append to kernel parameters: ";
pascal@13551 589 for (i = 3; i < (size_t) argc; i++, msg = " ")
pascal@13318 590 printf("%s%s",msg,argv[i]);
pascal@13318 591 printf("\n\n Hit RETURN to continue.\n");
pascal@13317 592
pascal@12287 593 msg = "Load error";
pascal@12287 594 if (kmap->version != 1 ||
pascal@12287 595 loadfile(argv[1], (void **) &kbdmap, &map_size) ||
pascal@12287 596 strncmp(kbdmap, "07070", 5))
pascal@12287 597 goto kbdmap_error;
pascal@12287 598
pascal@12287 599 // search for mapfile in cpio archive
pascal@12287 600 for (i = 0; i < map_size;) {
pascal@12287 601 int len, j;
pascal@12287 602 char *name;
pascal@12287 603
pascal@12287 604 for (j = size = 0; j < 8; j++) {
pascal@12287 605 char c = kbdmap[54 + i + j] - '0';
pascal@12287 606 if (c > 9) c += '0' + 10 - 'A';
pascal@12287 607 size <<= 4;
pascal@12287 608 size += c;
pascal@12287 609 }
pascal@12287 610 i += 110;
pascal@12287 611 name = kbdmap + i;
pascal@12287 612 len = 1 + strlen(name);
pascal@12287 613 i += len;
pascal@12287 614 i += ((-i)&3);
pascal@12287 615 if (!strcmp(name, argv[2])) {
pascal@12287 616 kbdmap += i;
pascal@12287 617 break;
pascal@12287 618 }
pascal@12287 619 i += size + ((-size)&3);
pascal@12287 620 }
pascal@12287 621
pascal@12287 622 msg = "Filename error";
pascal@12287 623 if (i >= map_size)
pascal@12287 624 goto kbdmap_error;
pascal@12287 625
pascal@12287 626 msg = "Format error";
pascal@12287 627 if (size != kmap->length)
pascal@12287 628 goto kbdmap_error;
pascal@12287 629
pascal@12287 630 memcpy(kmap->map, kbdmap, size);
pascal@12287 631
pascal@12287 632 return 0;
pascal@12287 633
pascal@12287 634 kbdmap_error:
pascal@12287 635 printf("%s.\n",msg);
pascal@12287 636 return 1;
pascal@12287 637 }
pascal@12287 638
pascal@12287 639 /* ----------------------------------------------------------------------- *
pascal@12287 640 *
pascal@12287 641 * Copyright 2007-2008 H. Peter Anvin - All Rights Reserved
pascal@13551 642 * Copyright 2009-2012 Intel Corporation; author: H. Peter Anvin
pascal@12287 643 *
pascal@12287 644 * Permission is hereby granted, free of charge, to any person
pascal@12287 645 * obtaining a copy of this software and associated documentation
pascal@12287 646 * files (the "Software"), to deal in the Software without
pascal@12287 647 * restriction, including without limitation the rights to use,
pascal@12287 648 * copy, modify, merge, publish, distribute, sublicense, and/or
pascal@12287 649 * sell copies of the Software, and to permit persons to whom
pascal@12287 650 * the Software is furnished to do so, subject to the following
pascal@12287 651 * conditions:
pascal@12287 652 *
pascal@12287 653 * The above copyright notice and this permission notice shall
pascal@12287 654 * be included in all copies or substantial portions of the Software.
pascal@12287 655 *
pascal@12287 656 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND,
pascal@12287 657 * EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES
pascal@12287 658 * OF MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND
pascal@12287 659 * NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT
pascal@12287 660 * HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY,
pascal@12287 661 * WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING
pascal@12287 662 * FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR
pascal@12287 663 * OTHER DEALINGS IN THE SOFTWARE.
pascal@12287 664 *
pascal@12287 665 * ----------------------------------------------------------------------- */
pascal@12287 666
pascal@12287 667 /*
pascal@12287 668 * linux.c
pascal@12287 669 *
pascal@12287 670 * Sample module to load Linux kernels. This module can also create
pascal@12287 671 * a file out of the DHCP return data if running under PXELINUX.
pascal@12287 672 *
pascal@12287 673 * If -dhcpinfo is specified, the DHCP info is written into the file
pascal@12287 674 * /dhcpinfo.dat in the initramfs.
pascal@12287 675 *
pascal@12287 676 * Usage: linux.c32 [-dhcpinfo] kernel arguments...
pascal@12287 677 */
pascal@12287 678
pascal@13551 679 #include <errno.h>
pascal@12287 680 #include <stdbool.h>
pascal@12287 681 #include <stdlib.h>
pascal@12287 682 #include <stdio.h>
pascal@12287 683 #include <string.h>
pascal@12287 684 #include <console.h>
pascal@17057 685 #include <cpuid.h>
pascal@12287 686 #include <syslinux/loadfile.h>
pascal@12287 687 #include <syslinux/linux.h>
pascal@12287 688 #include <syslinux/pxe.h>
pascal@12287 689
pascal@12287 690 const char *progname = "linux.c32";
pascal@12287 691
pascal@12287 692 /* Find the last instance of a particular command line argument
pascal@12287 693 (which should include the final =; do not use for boolean arguments) */
pascal@12287 694 static char *find_argument(char **argv, const char *argument)
pascal@12287 695 {
pascal@12287 696 int la = strlen(argument);
pascal@12287 697 char **arg;
pascal@12287 698 char *ptr = NULL;
pascal@12287 699
pascal@12287 700 for (arg = argv; *arg; arg++) {
pascal@12287 701 if (!memcmp(*arg, argument, la))
pascal@12287 702 ptr = *arg + la;
pascal@12287 703 }
pascal@12287 704
pascal@12287 705 return ptr;
pascal@12287 706 }
pascal@12287 707
pascal@12287 708 /* Search for a boolean argument; return its position, or 0 if not present */
pascal@12287 709 static int find_boolean(char **argv, const char *argument)
pascal@12287 710 {
pascal@12287 711 char **arg;
pascal@12287 712
pascal@12287 713 for (arg = argv; *arg; arg++) {
pascal@12287 714 if (!strcmp(*arg, argument))
pascal@12287 715 return (arg - argv) + 1;
pascal@12287 716 }
pascal@12287 717
pascal@12287 718 return 0;
pascal@12287 719 }
pascal@12287 720
pascal@18674 721 static int got_config;
pascal@18674 722 static char *custom_cmdline = "";
pascal@18674 723 static int custom_initrdlen;
pascal@18674 724 static char *custom_initrdbase;
pascal@18674 725 static char *custom_buffer;
pascal@18674 726 static struct disk_info diskinfo;
pascal@18674 727
pascal@18674 728 static int has_custom_config(void)
pascal@18674 729 {
pascal@18674 730 const union syslinux_derivative_info *sdi;
pascal@18674 731
pascal@18674 732 if (got_config)
pascal@18674 733 goto done;
pascal@18674 734 sdi = syslinux_derivative_info();
pascal@18674 735 if (sdi->c.filesystem != SYSLINUX_FS_ISOLINUX)
pascal@18674 736 goto fail;
pascal@18674 737 disk_get_params(sdi->iso.drive_number, &diskinfo);
pascal@18674 738 custom_buffer = disk_read_sectors(&diskinfo, 32768 / diskinfo.bps, 1);
pascal@18674 739 got_config = (16 + *(unsigned long *) (custom_buffer + 80))
pascal@18674 740 * 2048 / diskinfo.bps;
pascal@18674 741 free(custom_buffer);
pascal@18674 742 custom_buffer = disk_read_sectors(&diskinfo, got_config, 1);
pascal@18674 743 if (!memcmp(custom_buffer,"#!boot ",7)) {
pascal@18674 744 char *p = custom_buffer+7+32+1;
pascal@18674 745
pascal@18674 746 if (!memcmp(p,"append=",7)) {
pascal@18674 747 custom_cmdline = p + 7;
pascal@18674 748 p = strchr(p,'\n');
pascal@18674 749 *p++ = 0;
pascal@18674 750 }
pascal@18674 751 if (!memcmp(p,"initrd:",7)) {
pascal@18674 752 custom_initrdlen = strtoul(p + 7, &custom_initrdbase, 10);
pascal@18674 753 custom_initrdbase++;
pascal@18674 754 }
pascal@18674 755 return 1;
pascal@18674 756 }
pascal@18674 757 fail:
pascal@18674 758 got_config = -1;
pascal@18674 759 done:
pascal@18674 760 return got_config > 0;
pascal@18674 761 }
pascal@18674 762
pascal@18674 763 static int loadcustominitrd(void **data)
pascal@18674 764 {
pascal@18674 765 int n, len;
pascal@18674 766 char *p;
pascal@18674 767
pascal@18674 768 p = *data = malloc(custom_initrdlen);
pascal@18674 769 if (!p) return 0;
pascal@18674 770 len = custom_initrdlen;
pascal@18674 771 while (1) {
pascal@18674 772 n = 2048 + custom_buffer - custom_initrdbase;
pascal@18674 773 if (n > len)
pascal@18674 774 n = len;
pascal@18674 775 memcpy(p, custom_initrdbase, n);
pascal@18674 776 p += n;
pascal@18674 777 len -= n;
pascal@18674 778 if (len == 0)
pascal@18674 779 break;
pascal@18674 780 free(custom_buffer);
pascal@18677 781 got_config += 2048 / diskinfo.bps;
pascal@18674 782 custom_initrdbase = custom_buffer =
pascal@18674 783 disk_read_sectors(&diskinfo, got_config, 2048 / diskinfo.bps);
pascal@18674 784 }
pascal@18674 785 return 1;
pascal@18674 786 }
pascal@18674 787
pascal@12287 788 /* Stitch together the command line from a set of argv's */
pascal@12287 789 static char *make_cmdline(char **argv)
pascal@12287 790 {
pascal@12287 791 char **arg;
pascal@13552 792 size_t bytes, size;
pascal@12287 793 char *cmdline, *p;
pascal@13552 794 int i;
pascal@12287 795
pascal@12287 796 bytes = 1; /* Just in case we have a zero-entry cmdline */
pascal@12287 797 for (arg = argv; *arg; arg++) {
pascal@12287 798 bytes += strlen(*arg) + 1;
pascal@12287 799 }
pascal@13552 800 for (i = 0; i < 255; i++)
pascal@13552 801 if (syslinux_getadv(i, &size))
pascal@13552 802 bytes += ++size;
pascal@18674 803 if (has_custom_config())
pascal@18674 804 bytes += strlen(custom_cmdline) + 1;
pascal@13552 805
pascal@12287 806 p = cmdline = malloc(bytes);
pascal@12287 807 if (!cmdline)
pascal@12287 808 return NULL;
pascal@12287 809
pascal@12287 810 for (arg = argv; *arg; arg++) {
pascal@12287 811 int len = strlen(*arg);
pascal@12287 812 memcpy(p, *arg, len);
pascal@12287 813 p[len] = ' ';
pascal@12287 814 p += len + 1;
pascal@12287 815 }
pascal@12287 816
pascal@13552 817 for (i = 0; i < 255; i++) {
pascal@13552 818 const void *q = syslinux_getadv(i, &size);
pascal@13552 819 if (q == NULL) continue;
pascal@13552 820 memcpy(p, q, size);
pascal@13552 821 p[size] = ' ';
pascal@13552 822 p += size + 1;
pascal@13552 823 }
pascal@13552 824
pascal@12287 825 if (p > cmdline)
pascal@12287 826 p--; /* Remove the last space */
pascal@12287 827 *p = '\0';
pascal@18674 828
pascal@18674 829 if (has_custom_config()) {
pascal@18674 830 *p++ = ' ';
pascal@18674 831 strcat(p, custom_cmdline);
pascal@18674 832 }
pascal@12287 833
pascal@12287 834 return cmdline;
pascal@12287 835 }
pascal@12287 836
pascal@17057 837 static bool __constfunc cpu_has_cpuid(void)
pascal@17057 838 {
pascal@17057 839 return cpu_has_eflag(X86_EFLAGS_ID);
pascal@17057 840 }
pascal@17057 841
pascal@17057 842 static bool __constfunc cpu_has_level(uint32_t level)
pascal@17057 843 {
pascal@17057 844 uint32_t group;
pascal@17057 845 uint32_t limit;
pascal@17057 846
pascal@17057 847 if (!cpu_has_cpuid())
pascal@17057 848 return false;
pascal@17057 849
pascal@17057 850 group = level & 0xffff0000;
pascal@17057 851 limit = cpuid_eax(group);
pascal@17057 852
pascal@17057 853 if ((limit & 0xffff0000) != group)
pascal@17057 854 return false;
pascal@17057 855
pascal@17057 856 if (level > limit)
pascal@17057 857 return false;
pascal@17057 858
pascal@17057 859 return true;
pascal@17057 860 }
pascal@17057 861
pascal@17057 862 /* This only supports feature groups 0 and 1, corresponding to the
pascal@17057 863 Intel and AMD EDX bit vectors. We can add more later if need be. */
pascal@17057 864 static bool __constfunc cpu_has_feature(int x)
pascal@17057 865 {
pascal@17057 866 uint32_t level = ((x & 1) << 31) | 1;
pascal@17057 867
pascal@17057 868 return cpu_has_level(level) && ((cpuid_edx(level) >> (x & 31) & 1));
pascal@17057 869 }
pascal@17057 870
pascal@18675 871 static const char *extfilename(const char *filename, char *ext, int feature)
pascal@17057 872 {
pascal@17060 873 #define NEWFILENAMESZ 256
pascal@17057 874 static char newfilename[NEWFILENAMESZ+1];
pascal@18675 875 const char *found = filename;
pascal@17060 876 char *new = newfilename;
pascal@17060 877 int fd;
pascal@17057 878
pascal@17057 879 if (strlen(filename) + strlen(ext) <= NEWFILENAMESZ) {
pascal@17058 880 strcpy(newfilename, filename);
pascal@17057 881 if (cpu_has_feature(feature)) {
pascal@17057 882 strcat(newfilename, ext);
pascal@17060 883 fd = open(new, O_RDONLY);
pascal@17060 884 if (fd < 0)
pascal@17060 885 fd = open(new = unrockridge(new), O_RDONLY);
pascal@17060 886 if (fd >= 0) {
pascal@17060 887 found = new;
pascal@17060 888 close(fd);
pascal@17060 889 }
pascal@17057 890 }
pascal@17057 891 }
pascal@17057 892 return found;
pascal@17057 893 }
pascal@17057 894
pascal@18675 895 static const char *bestextfilename(const char *filename)
pascal@17057 896 {
pascal@18675 897 const char *found;
pascal@17057 898
pascal@17057 899 //found = extfilename(filename, "fpu", X86_FEATURE_FPU);
pascal@17057 900 //found = extfilename(filename, "686", X86_FEATURE_CMOV);
pascal@17057 901 //found = extfilename(filename, "pae", X86_FEATURE_PAE);
pascal@17057 902 found = extfilename(filename, "64", X86_FEATURE_LM);
pascal@17057 903 //found = extfilename(filename, "guest", X86_FEATURE_HYPERVISOR);
pascal@17057 904 return found;
pascal@17057 905 }
pascal@17057 906
pascal@13551 907 static int setup_data_file(struct setup_data *setup_data,
pascal@13551 908 uint32_t type, const char *filename,
pascal@13551 909 bool opt_quiet)
pascal@13551 910 {
pascal@13551 911 if (!opt_quiet)
pascal@13551 912 printf("Loading %s... ", filename);
pascal@13551 913
pascal@13551 914 if (setup_data_load(setup_data, type, filename)) {
pascal@13551 915 if (opt_quiet)
pascal@13551 916 printf("Loading %s ", filename);
pascal@13551 917 printf("failed\n");
pascal@13551 918 return -1;
pascal@13551 919 }
pascal@13551 920
pascal@13551 921 if (!opt_quiet)
pascal@13551 922 printf("ok\n");
pascal@13551 923
pascal@13551 924 return 0;
pascal@13551 925 }
pascal@13551 926
pascal@12287 927 static int main_linux(int argc, char *argv[])
pascal@12287 928 {
pascal@12287 929 const char *kernel_name;
pascal@17057 930 const char *initrd_name;
pascal@12287 931 struct initramfs *initramfs;
pascal@13551 932 struct setup_data *setup_data;
pascal@12287 933 char *cmdline;
pascal@12287 934 char *boot_image;
pascal@12287 935 void *kernel_data;
pascal@12287 936 size_t kernel_len;
pascal@12287 937 bool opt_dhcpinfo = false;
pascal@12287 938 bool opt_quiet = false;
pascal@12287 939 void *dhcpdata;
pascal@12287 940 size_t dhcplen;
pascal@13551 941 char **argp, **argl, *arg, *p;
pascal@13551 942
pascal@13551 943 openconsole(&dev_null_r, &dev_stdcon_w);
pascal@12287 944
pascal@12287 945 (void)argc;
pascal@12287 946 argp = argv + 1;
pascal@12287 947
pascal@12287 948 while ((arg = *argp) && arg[0] == '-') {
pascal@12287 949 if (!strcmp("-dhcpinfo", arg)) {
pascal@12287 950 opt_dhcpinfo = true;
pascal@12287 951 } else {
pascal@12287 952 fprintf(stderr, "%s: unknown option: %s\n", progname, arg);
pascal@12287 953 return 1;
pascal@12287 954 }
pascal@12287 955 argp++;
pascal@12287 956 }
pascal@12287 957
pascal@12287 958 if (!arg) {
pascal@12287 959 fprintf(stderr, "%s: missing kernel name\n", progname);
pascal@12287 960 return 1;
pascal@12287 961 }
pascal@12287 962
pascal@17061 963 kernel_name = arg;
pascal@12287 964
pascal@13551 965 errno = 0;
pascal@12287 966 boot_image = malloc(strlen(kernel_name) + 12);
pascal@13551 967 if (!boot_image) {
pascal@13551 968 fprintf(stderr, "Error allocating BOOT_IMAGE string: ");
pascal@12287 969 goto bail;
pascal@13551 970 }
pascal@12287 971 strcpy(boot_image, "BOOT_IMAGE=");
pascal@12287 972 strcpy(boot_image + 11, kernel_name);
pascal@12287 973 /* argp now points to the kernel name, and the command line follows.
pascal@12287 974 Overwrite the kernel name with the BOOT_IMAGE= argument, and thus
pascal@12287 975 we have the final argument. */
pascal@12287 976 *argp = boot_image;
pascal@12287 977
pascal@12287 978 if (find_boolean(argp, "quiet"))
pascal@12287 979 opt_quiet = true;
pascal@12287 980
pascal@12287 981 if (!opt_quiet)
pascal@12287 982 printf("Loading %s... ", kernel_name);
pascal@13551 983 errno = 0;
pascal@17061 984 if (loadfile(bestextfilename(kernel_name), &kernel_data, &kernel_len)) {
pascal@12287 985 if (opt_quiet)
pascal@12287 986 printf("Loading %s ", kernel_name);
pascal@13551 987 printf("failed: ");
pascal@12287 988 goto bail;
pascal@12287 989 }
pascal@12287 990 if (!opt_quiet)
pascal@12287 991 printf("ok\n");
pascal@12287 992
pascal@13551 993 errno = 0;
pascal@12287 994 cmdline = make_cmdline(argp);
pascal@13551 995 if (!cmdline) {
pascal@13551 996 fprintf(stderr, "make_cmdline() failed: ");
pascal@12287 997 goto bail;
pascal@13551 998 }
pascal@12287 999
pascal@12287 1000 /* Initialize the initramfs chain */
pascal@13551 1001 errno = 0;
pascal@12287 1002 initramfs = initramfs_init();
pascal@13551 1003 if (!initramfs) {
pascal@13551 1004 fprintf(stderr, "initramfs_init() failed: ");
pascal@12287 1005 goto bail;
pascal@13551 1006 }
pascal@12287 1007
pascal@12287 1008 if ((arg = find_argument(argp, "initrd="))) {
pascal@12287 1009 do {
pascal@12287 1010 p = strchr(arg, ',');
pascal@12287 1011 if (p)
pascal@12287 1012 *p = '\0';
pascal@12287 1013
pascal@17061 1014 initrd_name = arg;
pascal@12287 1015 if (!opt_quiet)
pascal@17057 1016 printf("Loading %s... ", initrd_name);
pascal@13551 1017 errno = 0;
pascal@17061 1018 if (initramfs_load_archive(initramfs, bestextfilename(initrd_name))) {
pascal@12287 1019 if (opt_quiet)
pascal@17057 1020 printf("Loading %s ", initrd_name);
pascal@13551 1021 printf("failed: ");
pascal@12287 1022 goto bail;
pascal@12287 1023 }
pascal@12287 1024 if (!opt_quiet)
pascal@12287 1025 printf("ok\n");
pascal@12287 1026
pascal@12287 1027 if (p)
pascal@12287 1028 *p++ = ',';
pascal@12287 1029 } while ((arg = p));
pascal@12287 1030 }
pascal@12287 1031
pascal@12287 1032 /* Append the DHCP info */
pascal@12287 1033 if (opt_dhcpinfo &&
pascal@12287 1034 !pxe_get_cached_info(PXENV_PACKET_TYPE_DHCP_ACK, &dhcpdata, &dhcplen)) {
pascal@13551 1035 errno = 0;
pascal@12287 1036 if (initramfs_add_file(initramfs, dhcpdata, dhcplen, dhcplen,
pascal@13551 1037 "/dhcpinfo.dat", 0, 0755)) {
pascal@13551 1038 fprintf(stderr, "Unable to add DHCP info: ");
pascal@12287 1039 goto bail;
pascal@13551 1040 }
pascal@13551 1041 }
pascal@13551 1042
pascal@18674 1043 if (has_custom_config() && custom_initrdlen) {
pascal@18674 1044 void *data;
pascal@18674 1045
pascal@18674 1046 if (!opt_quiet)
pascal@18674 1047 printf("Loading custom initrd... ");
pascal@18674 1048 if (loadcustominitrd(&data))
pascal@18674 1049 initramfs_add_data(initramfs, data, custom_initrdlen, custom_initrdlen, 4);
pascal@18674 1050 }
pascal@18674 1051
pascal@13551 1052 /* Handle dtb and eventually other setup data */
pascal@13551 1053 setup_data = setup_data_init();
pascal@13551 1054 if (!setup_data)
pascal@13551 1055 goto bail;
pascal@13551 1056
pascal@13551 1057 for (argl = argv; (arg = *argl); argl++) {
pascal@13551 1058 if (!memcmp(arg, "dtb=", 4)) {
pascal@13551 1059 if (setup_data_file(setup_data, SETUP_DTB, arg+4, opt_quiet))
pascal@13551 1060 goto bail;
pascal@13551 1061 } else if (!memcmp(arg, "blob.", 5)) {
pascal@13551 1062 uint32_t type;
pascal@13551 1063 char *ep;
pascal@13551 1064
pascal@13551 1065 type = strtoul(arg + 5, &ep, 10);
pascal@13551 1066 if (ep[0] != '=' || !ep[1])
pascal@13551 1067 continue;
pascal@13551 1068
pascal@13551 1069 if (!type)
pascal@13551 1070 continue;
pascal@13551 1071
pascal@13551 1072 if (setup_data_file(setup_data, type, ep+1, opt_quiet))
pascal@13551 1073 goto bail;
pascal@13551 1074 }
pascal@12287 1075 }
pascal@12287 1076
pascal@12287 1077 /* This should not return... */
pascal@13551 1078 errno = 0;
pascal@13551 1079 syslinux_boot_linux(kernel_data, kernel_len, initramfs,
pascal@13551 1080 setup_data, cmdline);
pascal@13551 1081 fprintf(stderr, "syslinux_boot_linux() failed: ");
pascal@12287 1082
pascal@12287 1083 bail:
pascal@13551 1084 switch(errno) {
pascal@13551 1085 case ENOENT:
pascal@13551 1086 fprintf(stderr, "File not found\n");
pascal@13551 1087 break;
pascal@13551 1088 case ENOMEM:
pascal@13551 1089 fprintf(stderr, "Out of memory\n");
pascal@13551 1090 break;
pascal@13551 1091 default:
pascal@13551 1092 fprintf(stderr, "Error %d\n", errno);
pascal@13551 1093 break;
pascal@13551 1094 }
pascal@13551 1095 fprintf(stderr, "%s: Boot aborted!\n", progname);
pascal@12287 1096 return 1;
pascal@12287 1097 }
pascal@12287 1098
pascal@12349 1099 static int main_setarg(int argc, char *argv[])
pascal@12349 1100 {
pascal@12349 1101 if (argc < 3) {
pascal@12349 1102 usage("Usage: setarg.c32 argnum [args]...");
pascal@12349 1103 }
pascal@12349 1104 setlinuxarg(atoi(argv[1]), argc - 2, argv + 2);
pascal@12349 1105 return 0;
pascal@12349 1106 }
pascal@12349 1107
pascal@12349 1108 static int main_ifarg(int argc, char *argv[])
pascal@12349 1109 {
pascal@12349 1110 int i;
pascal@12349 1111 size_t size;
pascal@12349 1112
pascal@12349 1113 if (argc < 3) {
pascal@12349 1114 usage("Usage: ifarg.c32 [argnum labelifset]... labelifnoneset");
pascal@12349 1115 }
pascal@12349 1116 for (i = 1; i < argc - 1; i += 2) {
pascal@13295 1117 int n = atoi(argv[i]);
pascal@13295 1118 if (n == -1) {
pascal@13295 1119 for (n = 0; n < 255; n++) {
pascal@13316 1120 if (syslinux_getadv(n, &size))
pascal@13295 1121 goto found;
pascal@13295 1122 }
pascal@13295 1123 continue;
pascal@13295 1124 }
pascal@13295 1125 else if (! syslinux_getadv(n, &size)) continue;
pascal@13295 1126 found:
pascal@13295 1127 syslinux_run_command(argv[i+1]);
pascal@12349 1128 }
pascal@12349 1129 if (i != argc) syslinux_run_command(argv[i]);
pascal@12349 1130 else syslinux_run_default();
pascal@12349 1131 return 0;
pascal@12349 1132 }
pascal@12349 1133
pascal@12349 1134 /* ----------------------------------------------------------------------- *
pascal@12349 1135 *
pascal@12349 1136 * Copyright 2007-2008 H. Peter Anvin - All Rights Reserved
pascal@12349 1137 *
pascal@12349 1138 * This program is free software; you can redistribute it and/or modify
pascal@12349 1139 * it under the terms of the GNU General Public License as published by
pascal@12349 1140 * the Free Software Foundation, Inc., 53 Temple Place Ste 330,
pascal@12349 1141 * Boston MA 02111-1307, USA; either version 2 of the License, or
pascal@12349 1142 * (at your option) any later version; incorporated herein by reference.
pascal@12349 1143 *
pascal@12349 1144 * ----------------------------------------------------------------------- */
pascal@12349 1145
pascal@12349 1146 static int main_listarg(int argc, char *argv[])
pascal@12349 1147 {
pascal@12349 1148 uint8_t *p, *ep;
pascal@12349 1149 size_t s = syslinux_adv_size();
pascal@12349 1150 char buf[256];
pascal@12349 1151
pascal@12349 1152 (void) argc;
pascal@12349 1153 (void) argv;
pascal@12349 1154 p = syslinux_adv_ptr();
pascal@12349 1155
pascal@12349 1156 printf("args size: %zd bytes at %p\n", s, p);
pascal@12349 1157
pascal@12349 1158 ep = p + s; /* Need at least opcode+len */
pascal@12349 1159 while (p < ep - 1 && *p) {
pascal@12349 1160 int t = *p++;
pascal@12349 1161 int l = *p++;
pascal@12349 1162
pascal@12349 1163 if (p + l > ep)
pascal@12349 1164 break;
pascal@12349 1165
pascal@12349 1166 memcpy(buf, p, l);
pascal@12349 1167 buf[l] = '\0';
pascal@12349 1168
pascal@12349 1169 printf("arg %3d: \"%s\"\n", t, buf);
pascal@12349 1170
pascal@12349 1171 p += l;
pascal@12349 1172 }
pascal@12349 1173 sleep(5);
pascal@12349 1174 return 0;
pascal@12349 1175 }
pascal@12349 1176
pascal@12273 1177 int main(int argc, char *argv[])
pascal@12273 1178 {
pascal@12273 1179 unsigned i;
pascal@12273 1180 static struct {
pascal@12273 1181 char *name;
pascal@12273 1182 int (*main)(int argc, char *argv[]);
pascal@12273 1183 } bin[] = {
pascal@13295 1184 { "say", main_say },
pascal@13295 1185 { "md5sum", main_md5sum },
pascal@13295 1186 { "ifmem", main_ifmem },
pascal@13295 1187 { "reboot", main_reboot },
pascal@12287 1188 { "poweroff", main_poweroff },
pascal@13295 1189 { "kbdmap", main_kbdmap },
pascal@13295 1190 { "linux", main_linux },
pascal@13295 1191 { "setarg", main_setarg },
pascal@13295 1192 { "ifarg", main_ifarg },
pascal@13295 1193 { "listarg", main_listarg }
pascal@12273 1194 };
pascal@12273 1195
pascal@12273 1196 openconsole(&dev_null_r, &dev_stdcon_w);
pascal@12273 1197
pascal@12273 1198 if (strstr(argv[0], "c32box")) { argc--; argv++; }
pascal@12273 1199 for (i = 0; i < sizeof(bin)/sizeof(bin[0]); i++)
pascal@12273 1200 if (strstr(argv[0], bin[i].name))
pascal@12273 1201 return bin[i].main(argc, argv);
pascal@12287 1202 printf("No %s in c32box modules\n", argv[0]);
pascal@12287 1203 for (i = 0; i < sizeof(bin)/sizeof(bin[0]); i++)
pascal@12287 1204 printf(" %s \n",bin[i].name);
pascal@12273 1205 return 1;
pascal@12273 1206 }