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@18674
|
781 got_config += 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 }
|