1
2
3
4
5
6
7#include <common.h>
8#include <command.h>
9#include <env.h>
10#include <image.h>
11#include <log.h>
12#include <malloc.h>
13#include <mapmem.h>
14#include <lcd.h>
15#include <net.h>
16#include <fdt_support.h>
17#include <linux/libfdt.h>
18#include <linux/string.h>
19#include <linux/ctype.h>
20#include <errno.h>
21#include <linux/list.h>
22
23#include <splash.h>
24#include <asm/io.h>
25
26#include "menu.h"
27#include "cli.h"
28
29#include "pxe_utils.h"
30
31#define MAX_TFTP_PATH_LEN 512
32
33bool is_pxe;
34
35
36
37
38
39
40
41
42
43
44
45int format_mac_pxe(char *outbuf, size_t outbuf_len)
46{
47 uchar ethaddr[6];
48
49 if (outbuf_len < 21) {
50 printf("outbuf is too small (%zd < 21)\n", outbuf_len);
51
52 return -EINVAL;
53 }
54
55 if (!eth_env_get_enetaddr_by_index("eth", eth_get_dev_index(), ethaddr))
56 return -ENOENT;
57
58 sprintf(outbuf, "01-%02x-%02x-%02x-%02x-%02x-%02x",
59 ethaddr[0], ethaddr[1], ethaddr[2],
60 ethaddr[3], ethaddr[4], ethaddr[5]);
61
62 return 1;
63}
64
65
66
67
68
69
70static int get_bootfile_path(const char *file_path, char *bootfile_path,
71 size_t bootfile_path_size)
72{
73 char *bootfile, *last_slash;
74 size_t path_len = 0;
75
76
77 if (file_path[0] == '/' && !is_pxe)
78 goto ret;
79
80 bootfile = from_env("bootfile");
81
82 if (!bootfile)
83 goto ret;
84
85 last_slash = strrchr(bootfile, '/');
86
87 if (!last_slash)
88 goto ret;
89
90 path_len = (last_slash - bootfile) + 1;
91
92 if (bootfile_path_size < path_len) {
93 printf("bootfile_path too small. (%zd < %zd)\n",
94 bootfile_path_size, path_len);
95
96 return -1;
97 }
98
99 strncpy(bootfile_path, bootfile, path_len);
100
101 ret:
102 bootfile_path[path_len] = '\0';
103
104 return 1;
105}
106
107int (*do_getfile)(struct cmd_tbl *cmdtp, const char *file_path,
108 char *file_addr);
109
110
111
112
113
114
115
116
117
118static int get_relfile(struct cmd_tbl *cmdtp, const char *file_path,
119 unsigned long file_addr)
120{
121 size_t path_len;
122 char relfile[MAX_TFTP_PATH_LEN + 1];
123 char addr_buf[18];
124 int err;
125
126 err = get_bootfile_path(file_path, relfile, sizeof(relfile));
127
128 if (err < 0)
129 return err;
130
131 path_len = strlen(file_path);
132 path_len += strlen(relfile);
133
134 if (path_len > MAX_TFTP_PATH_LEN) {
135 printf("Base path too long (%s%s)\n", relfile, file_path);
136
137 return -ENAMETOOLONG;
138 }
139
140 strcat(relfile, file_path);
141
142 printf("Retrieving file: %s\n", relfile);
143
144 sprintf(addr_buf, "%lx", file_addr);
145
146 return do_getfile(cmdtp, relfile, addr_buf);
147}
148
149
150
151
152
153
154
155
156int get_pxe_file(struct cmd_tbl *cmdtp, const char *file_path,
157 unsigned long file_addr)
158{
159 unsigned long config_file_size;
160 char *tftp_filesize;
161 int err;
162 char *buf;
163
164 err = get_relfile(cmdtp, file_path, file_addr);
165
166 if (err < 0)
167 return err;
168
169
170
171
172
173 tftp_filesize = from_env("filesize");
174
175 if (!tftp_filesize)
176 return -ENOENT;
177
178 if (strict_strtoul(tftp_filesize, 16, &config_file_size) < 0)
179 return -EINVAL;
180
181 buf = map_sysmem(file_addr + config_file_size, 1);
182 *buf = '\0';
183 unmap_sysmem(buf);
184
185 return 1;
186}
187
188#define PXELINUX_DIR "pxelinux.cfg/"
189
190
191
192
193
194
195
196
197int get_pxelinux_path(struct cmd_tbl *cmdtp, const char *file,
198 unsigned long pxefile_addr_r)
199{
200 size_t base_len = strlen(PXELINUX_DIR);
201 char path[MAX_TFTP_PATH_LEN + 1];
202
203 if (base_len + strlen(file) > MAX_TFTP_PATH_LEN) {
204 printf("path (%s%s) too long, skipping\n",
205 PXELINUX_DIR, file);
206 return -ENAMETOOLONG;
207 }
208
209 sprintf(path, PXELINUX_DIR "%s", file);
210
211 return get_pxe_file(cmdtp, path, pxefile_addr_r);
212}
213
214
215
216
217
218
219
220
221static int get_relfile_envaddr(struct cmd_tbl *cmdtp, const char *file_path,
222 const char *envaddr_name)
223{
224 unsigned long file_addr;
225 char *envaddr;
226
227 envaddr = from_env(envaddr_name);
228
229 if (!envaddr)
230 return -ENOENT;
231
232 if (strict_strtoul(envaddr, 16, &file_addr) < 0)
233 return -EINVAL;
234
235 return get_relfile(cmdtp, file_path, file_addr);
236}
237
238
239
240
241
242
243
244static struct pxe_label *label_create(void)
245{
246 struct pxe_label *label;
247
248 label = malloc(sizeof(struct pxe_label));
249
250 if (!label)
251 return NULL;
252
253 memset(label, 0, sizeof(struct pxe_label));
254
255 return label;
256}
257
258
259
260
261
262
263
264
265
266static void label_destroy(struct pxe_label *label)
267{
268 if (label->name)
269 free(label->name);
270
271 if (label->kernel)
272 free(label->kernel);
273
274 if (label->config)
275 free(label->config);
276
277 if (label->append)
278 free(label->append);
279
280 if (label->initrd)
281 free(label->initrd);
282
283 if (label->fdt)
284 free(label->fdt);
285
286 if (label->fdtdir)
287 free(label->fdtdir);
288
289 if (label->fdtoverlays)
290 free(label->fdtoverlays);
291
292 free(label);
293}
294
295
296
297
298
299
300
301static void label_print(void *data)
302{
303 struct pxe_label *label = data;
304 const char *c = label->menu ? label->menu : label->name;
305
306 printf("%s:\t%s\n", label->num, c);
307}
308
309
310
311
312
313
314
315
316
317
318static int label_localboot(struct pxe_label *label)
319{
320 char *localcmd;
321
322 localcmd = from_env("localcmd");
323
324 if (!localcmd)
325 return -ENOENT;
326
327 if (label->append) {
328 char bootargs[CONFIG_SYS_CBSIZE];
329
330 cli_simple_process_macros(label->append, bootargs,
331 sizeof(bootargs));
332 env_set("bootargs", bootargs);
333 }
334
335 debug("running: %s\n", localcmd);
336
337 return run_command_list(localcmd, strlen(localcmd), 0);
338}
339
340
341
342
343#ifdef CONFIG_OF_LIBFDT_OVERLAY
344static void label_boot_fdtoverlay(struct cmd_tbl *cmdtp, struct pxe_label *label)
345{
346 char *fdtoverlay = label->fdtoverlays;
347 struct fdt_header *working_fdt;
348 char *fdtoverlay_addr_env;
349 ulong fdtoverlay_addr;
350 ulong fdt_addr;
351 int err;
352
353
354 fdt_addr = hextoul(env_get("fdt_addr_r"), NULL);
355 working_fdt = map_sysmem(fdt_addr, 0);
356 err = fdt_check_header(working_fdt);
357 if (err)
358 return;
359
360
361 fdtoverlay_addr_env = env_get("fdtoverlay_addr_r");
362 if (!fdtoverlay_addr_env) {
363 printf("Invalid fdtoverlay_addr_r for loading overlays\n");
364 return;
365 }
366
367 fdtoverlay_addr = hextoul(fdtoverlay_addr_env, NULL);
368
369
370 do {
371 struct fdt_header *blob;
372 char *overlayfile;
373 char *end;
374 int len;
375
376
377 while (*fdtoverlay == ' ')
378 ++fdtoverlay;
379
380
381 end = strstr(fdtoverlay, " ");
382 if (end) {
383 len = (int)(end - fdtoverlay);
384 overlayfile = malloc(len + 1);
385 strncpy(overlayfile, fdtoverlay, len);
386 overlayfile[len] = '\0';
387 } else
388 overlayfile = fdtoverlay;
389
390 if (!strlen(overlayfile))
391 goto skip_overlay;
392
393
394 err = get_relfile_envaddr(cmdtp, overlayfile,
395 "fdtoverlay_addr_r");
396 if (err < 0) {
397 printf("Failed loading overlay %s\n", overlayfile);
398 goto skip_overlay;
399 }
400
401
402 fdt_shrink_to_minimum(working_fdt, 8192);
403
404 blob = map_sysmem(fdtoverlay_addr, 0);
405 err = fdt_check_header(blob);
406 if (err) {
407 printf("Invalid overlay %s, skipping\n",
408 overlayfile);
409 goto skip_overlay;
410 }
411
412 err = fdt_overlay_apply_verbose(working_fdt, blob);
413 if (err) {
414 printf("Failed to apply overlay %s, skipping\n",
415 overlayfile);
416 goto skip_overlay;
417 }
418
419skip_overlay:
420 if (end)
421 free(overlayfile);
422 } while ((fdtoverlay = strstr(fdtoverlay, " ")));
423}
424#endif
425
426
427
428
429
430
431
432
433
434
435
436
437
438
439
440
441static int label_boot(struct cmd_tbl *cmdtp, struct pxe_label *label)
442{
443 char *bootm_argv[] = { "bootm", NULL, NULL, NULL, NULL };
444 char initrd_str[28];
445 char mac_str[29] = "";
446 char ip_str[68] = "";
447 char *fit_addr = NULL;
448 int bootm_argc = 2;
449 int len = 0;
450 ulong kernel_addr;
451 void *buf;
452
453 label_print(label);
454
455 label->attempted = 1;
456
457 if (label->localboot) {
458 if (label->localboot_val >= 0)
459 label_localboot(label);
460 return 0;
461 }
462
463 if (!label->kernel) {
464 printf("No kernel given, skipping %s\n",
465 label->name);
466 return 1;
467 }
468
469 if (label->initrd) {
470 if (get_relfile_envaddr(cmdtp, label->initrd, "ramdisk_addr_r") < 0) {
471 printf("Skipping %s for failure retrieving initrd\n",
472 label->name);
473 return 1;
474 }
475
476 bootm_argv[2] = initrd_str;
477 strncpy(bootm_argv[2], env_get("ramdisk_addr_r"), 18);
478 strcat(bootm_argv[2], ":");
479 strncat(bootm_argv[2], env_get("filesize"), 9);
480 bootm_argc = 3;
481 }
482
483 if (get_relfile_envaddr(cmdtp, label->kernel, "kernel_addr_r") < 0) {
484 printf("Skipping %s for failure retrieving kernel\n",
485 label->name);
486 return 1;
487 }
488
489 if (label->ipappend & 0x1) {
490 sprintf(ip_str, " ip=%s:%s:%s:%s",
491 env_get("ipaddr"), env_get("serverip"),
492 env_get("gatewayip"), env_get("netmask"));
493 }
494
495 if (IS_ENABLED(CONFIG_CMD_NET)) {
496 if (label->ipappend & 0x2) {
497 int err;
498
499 strcpy(mac_str, " BOOTIF=");
500 err = format_mac_pxe(mac_str + 8, sizeof(mac_str) - 8);
501 if (err < 0)
502 mac_str[0] = '\0';
503 }
504 }
505
506 if ((label->ipappend & 0x3) || label->append) {
507 char bootargs[CONFIG_SYS_CBSIZE] = "";
508 char finalbootargs[CONFIG_SYS_CBSIZE];
509
510 if (strlen(label->append ?: "") +
511 strlen(ip_str) + strlen(mac_str) + 1 > sizeof(bootargs)) {
512 printf("bootarg overflow %zd+%zd+%zd+1 > %zd\n",
513 strlen(label->append ?: ""),
514 strlen(ip_str), strlen(mac_str),
515 sizeof(bootargs));
516 return 1;
517 }
518
519 if (label->append)
520 strncpy(bootargs, label->append, sizeof(bootargs));
521
522 strcat(bootargs, ip_str);
523 strcat(bootargs, mac_str);
524
525 cli_simple_process_macros(bootargs, finalbootargs,
526 sizeof(finalbootargs));
527 env_set("bootargs", finalbootargs);
528 printf("append: %s\n", finalbootargs);
529 }
530
531 bootm_argv[1] = env_get("kernel_addr_r");
532
533 if (label->config) {
534 int len = strlen(bootm_argv[1]) + strlen(label->config) + 1;
535
536 fit_addr = malloc(len);
537 if (!fit_addr) {
538 printf("malloc fail (FIT address)\n");
539 return 1;
540 }
541 snprintf(fit_addr, len, "%s%s", bootm_argv[1], label->config);
542 bootm_argv[1] = fit_addr;
543 }
544
545
546
547
548
549
550
551
552
553
554
555
556
557
558
559
560
561 bootm_argv[3] = env_get("fdt_addr_r");
562
563
564 if (bootm_argv[3]) {
565 char *fdtfile = NULL;
566 char *fdtfilefree = NULL;
567
568 if (label->fdt) {
569 fdtfile = label->fdt;
570 } else if (label->fdtdir) {
571 char *f1, *f2, *f3, *f4, *slash;
572
573 f1 = env_get("fdtfile");
574 if (f1) {
575 f2 = "";
576 f3 = "";
577 f4 = "";
578 } else {
579
580
581
582
583
584
585
586 f1 = env_get("soc");
587 f2 = "-";
588 f3 = env_get("board");
589 f4 = ".dtb";
590 if (!f1) {
591 f1 = "";
592 f2 = "";
593 }
594 if (!f3) {
595 f2 = "";
596 f3 = "";
597 }
598 }
599
600 len = strlen(label->fdtdir);
601 if (!len)
602 slash = "./";
603 else if (label->fdtdir[len - 1] != '/')
604 slash = "/";
605 else
606 slash = "";
607
608 len = strlen(label->fdtdir) + strlen(slash) +
609 strlen(f1) + strlen(f2) + strlen(f3) +
610 strlen(f4) + 1;
611 fdtfilefree = malloc(len);
612 if (!fdtfilefree) {
613 printf("malloc fail (FDT filename)\n");
614 goto cleanup;
615 }
616
617 snprintf(fdtfilefree, len, "%s%s%s%s%s%s",
618 label->fdtdir, slash, f1, f2, f3, f4);
619 fdtfile = fdtfilefree;
620 }
621
622 if (fdtfile) {
623 int err = get_relfile_envaddr(cmdtp, fdtfile,
624 "fdt_addr_r");
625
626 free(fdtfilefree);
627 if (err < 0) {
628 bootm_argv[3] = NULL;
629
630 if (label->fdt) {
631 printf("Skipping %s for failure retrieving FDT\n",
632 label->name);
633 goto cleanup;
634 }
635 }
636
637#ifdef CONFIG_OF_LIBFDT_OVERLAY
638 if (label->fdtoverlays)
639 label_boot_fdtoverlay(cmdtp, label);
640#endif
641 } else {
642 bootm_argv[3] = NULL;
643 }
644 }
645
646 if (!bootm_argv[3])
647 bootm_argv[3] = env_get("fdt_addr");
648
649 if (bootm_argv[3]) {
650 if (!bootm_argv[2])
651 bootm_argv[2] = "-";
652 bootm_argc = 4;
653 }
654
655 kernel_addr = genimg_get_kernel_addr(bootm_argv[1]);
656 buf = map_sysmem(kernel_addr, 0);
657
658 if (genimg_get_format(buf) != IMAGE_FORMAT_INVALID)
659 do_bootm(cmdtp, 0, bootm_argc, bootm_argv);
660
661 else if (IS_ENABLED(CONFIG_CMD_BOOTI))
662 do_booti(cmdtp, 0, bootm_argc, bootm_argv);
663
664 else if (IS_ENABLED(CONFIG_CMD_BOOTZ))
665 do_bootz(cmdtp, 0, bootm_argc, bootm_argv);
666
667 else if (IS_ENABLED(CONFIG_CMD_ZBOOT))
668 do_zboot_parent(cmdtp, 0, bootm_argc, bootm_argv, NULL);
669
670 unmap_sysmem(buf);
671
672cleanup:
673 if (fit_addr)
674 free(fit_addr);
675 return 1;
676}
677
678
679
680
681enum token_type {
682 T_EOL,
683 T_STRING,
684 T_EOF,
685 T_MENU,
686 T_TITLE,
687 T_TIMEOUT,
688 T_LABEL,
689 T_KERNEL,
690 T_LINUX,
691 T_APPEND,
692 T_INITRD,
693 T_LOCALBOOT,
694 T_DEFAULT,
695 T_PROMPT,
696 T_INCLUDE,
697 T_FDT,
698 T_FDTDIR,
699 T_FDTOVERLAYS,
700 T_ONTIMEOUT,
701 T_IPAPPEND,
702 T_BACKGROUND,
703 T_INVALID
704};
705
706
707
708
709struct token {
710 char *val;
711 enum token_type type;
712};
713
714
715
716
717static const struct token keywords[] = {
718 {"menu", T_MENU},
719 {"title", T_TITLE},
720 {"timeout", T_TIMEOUT},
721 {"default", T_DEFAULT},
722 {"prompt", T_PROMPT},
723 {"label", T_LABEL},
724 {"kernel", T_KERNEL},
725 {"linux", T_LINUX},
726 {"localboot", T_LOCALBOOT},
727 {"append", T_APPEND},
728 {"initrd", T_INITRD},
729 {"include", T_INCLUDE},
730 {"devicetree", T_FDT},
731 {"fdt", T_FDT},
732 {"devicetreedir", T_FDTDIR},
733 {"fdtdir", T_FDTDIR},
734 {"fdtoverlays", T_FDTOVERLAYS},
735 {"ontimeout", T_ONTIMEOUT,},
736 {"ipappend", T_IPAPPEND,},
737 {"background", T_BACKGROUND,},
738 {NULL, T_INVALID}
739};
740
741
742
743
744
745
746enum lex_state {
747 L_NORMAL = 0,
748 L_KEYWORD,
749 L_SLITERAL
750};
751
752
753
754
755
756
757
758
759
760
761
762
763
764
765
766
767
768
769
770
771
772
773static char *get_string(char **p, struct token *t, char delim, int lower)
774{
775 char *b, *e;
776 size_t len, i;
777
778
779
780
781
782
783
784 b = *p;
785 e = *p;
786
787 while (*e) {
788 if ((delim == ' ' && isspace(*e)) || delim == *e)
789 break;
790 e++;
791 }
792
793 len = e - b;
794
795
796
797
798
799 t->val = malloc(len + 1);
800 if (!t->val)
801 return NULL;
802
803 for (i = 0; i < len; i++, b++) {
804 if (lower)
805 t->val[i] = tolower(*b);
806 else
807 t->val[i] = *b;
808 }
809
810 t->val[len] = '\0';
811
812
813
814
815 *p = e;
816
817 t->type = T_STRING;
818
819 return t->val;
820}
821
822
823
824
825static void get_keyword(struct token *t)
826{
827 int i;
828
829 for (i = 0; keywords[i].val; i++) {
830 if (!strcmp(t->val, keywords[i].val)) {
831 t->type = keywords[i].type;
832 break;
833 }
834 }
835}
836
837
838
839
840
841
842
843static void get_token(char **p, struct token *t, enum lex_state state)
844{
845 char *c = *p;
846
847 t->type = T_INVALID;
848
849
850 while (isblank(*c))
851 c++;
852
853
854
855
856
857 if (*c == '#') {
858 while (*c && *c != '\n')
859 c++;
860 }
861
862 if (*c == '\n') {
863 t->type = T_EOL;
864 c++;
865 } else if (*c == '\0') {
866 t->type = T_EOF;
867 c++;
868 } else if (state == L_SLITERAL) {
869 get_string(&c, t, '\n', 0);
870 } else if (state == L_KEYWORD) {
871
872
873
874
875
876
877
878 get_string(&c, t, ' ', 1);
879 get_keyword(t);
880 }
881
882 *p = c;
883}
884
885
886
887
888static void eol_or_eof(char **c)
889{
890 while (**c && **c != '\n')
891 (*c)++;
892}
893
894
895
896
897
898
899
900
901
902
903
904
905static int parse_sliteral(char **c, char **dst)
906{
907 struct token t;
908 char *s = *c;
909
910 get_token(c, &t, L_SLITERAL);
911
912 if (t.type != T_STRING) {
913 printf("Expected string literal: %.*s\n", (int)(*c - s), s);
914 return -EINVAL;
915 }
916
917 *dst = t.val;
918
919 return 1;
920}
921
922
923
924
925static int parse_integer(char **c, int *dst)
926{
927 struct token t;
928 char *s = *c;
929
930 get_token(c, &t, L_SLITERAL);
931
932 if (t.type != T_STRING) {
933 printf("Expected string: %.*s\n", (int)(*c - s), s);
934 return -EINVAL;
935 }
936
937 *dst = simple_strtol(t.val, NULL, 10);
938
939 free(t.val);
940
941 return 1;
942}
943
944static int parse_pxefile_top(struct cmd_tbl *cmdtp, char *p, unsigned long base,
945 struct pxe_menu *cfg, int nest_level);
946
947
948
949
950
951
952
953
954
955static int handle_include(struct cmd_tbl *cmdtp, char **c, unsigned long base,
956 struct pxe_menu *cfg, int nest_level)
957{
958 char *include_path;
959 char *s = *c;
960 int err;
961 char *buf;
962 int ret;
963
964 err = parse_sliteral(c, &include_path);
965
966 if (err < 0) {
967 printf("Expected include path: %.*s\n", (int)(*c - s), s);
968 return err;
969 }
970
971 err = get_pxe_file(cmdtp, include_path, base);
972
973 if (err < 0) {
974 printf("Couldn't retrieve %s\n", include_path);
975 return err;
976 }
977
978 buf = map_sysmem(base, 0);
979 ret = parse_pxefile_top(cmdtp, buf, base, cfg, nest_level);
980 unmap_sysmem(buf);
981
982 return ret;
983}
984
985
986
987
988
989
990
991
992
993
994
995static int parse_menu(struct cmd_tbl *cmdtp, char **c, struct pxe_menu *cfg,
996 unsigned long base, int nest_level)
997{
998 struct token t;
999 char *s = *c;
1000 int err = 0;
1001
1002 get_token(c, &t, L_KEYWORD);
1003
1004 switch (t.type) {
1005 case T_TITLE:
1006 err = parse_sliteral(c, &cfg->title);
1007
1008 break;
1009
1010 case T_INCLUDE:
1011 err = handle_include(cmdtp, c, base, cfg, nest_level + 1);
1012 break;
1013
1014 case T_BACKGROUND:
1015 err = parse_sliteral(c, &cfg->bmp);
1016 break;
1017
1018 default:
1019 printf("Ignoring malformed menu command: %.*s\n",
1020 (int)(*c - s), s);
1021 }
1022
1023 if (err < 0)
1024 return err;
1025
1026 eol_or_eof(c);
1027
1028 return 1;
1029}
1030
1031
1032
1033
1034static int parse_label_menu(char **c, struct pxe_menu *cfg,
1035 struct pxe_label *label)
1036{
1037 struct token t;
1038 char *s;
1039
1040 s = *c;
1041
1042 get_token(c, &t, L_KEYWORD);
1043
1044 switch (t.type) {
1045 case T_DEFAULT:
1046 if (!cfg->default_label)
1047 cfg->default_label = strdup(label->name);
1048
1049 if (!cfg->default_label)
1050 return -ENOMEM;
1051
1052 break;
1053 case T_LABEL:
1054 parse_sliteral(c, &label->menu);
1055 break;
1056 default:
1057 printf("Ignoring malformed menu command: %.*s\n",
1058 (int)(*c - s), s);
1059 }
1060
1061 eol_or_eof(c);
1062
1063 return 0;
1064}
1065
1066
1067
1068
1069
1070static int parse_label_kernel(char **c, struct pxe_label *label)
1071{
1072 char *s;
1073 int err;
1074
1075 err = parse_sliteral(c, &label->kernel);
1076 if (err < 0)
1077 return err;
1078
1079 s = strstr(label->kernel, "#");
1080 if (!s)
1081 return 1;
1082
1083 label->config = malloc(strlen(s) + 1);
1084 if (!label->config)
1085 return -ENOMEM;
1086
1087 strcpy(label->config, s);
1088 *s = 0;
1089
1090 return 1;
1091}
1092
1093
1094
1095
1096
1097
1098
1099
1100
1101static int parse_label(char **c, struct pxe_menu *cfg)
1102{
1103 struct token t;
1104 int len;
1105 char *s = *c;
1106 struct pxe_label *label;
1107 int err;
1108
1109 label = label_create();
1110 if (!label)
1111 return -ENOMEM;
1112
1113 err = parse_sliteral(c, &label->name);
1114 if (err < 0) {
1115 printf("Expected label name: %.*s\n", (int)(*c - s), s);
1116 label_destroy(label);
1117 return -EINVAL;
1118 }
1119
1120 list_add_tail(&label->list, &cfg->labels);
1121
1122 while (1) {
1123 s = *c;
1124 get_token(c, &t, L_KEYWORD);
1125
1126 err = 0;
1127 switch (t.type) {
1128 case T_MENU:
1129 err = parse_label_menu(c, cfg, label);
1130 break;
1131
1132 case T_KERNEL:
1133 case T_LINUX:
1134 err = parse_label_kernel(c, label);
1135 break;
1136
1137 case T_APPEND:
1138 err = parse_sliteral(c, &label->append);
1139 if (label->initrd)
1140 break;
1141 s = strstr(label->append, "initrd=");
1142 if (!s)
1143 break;
1144 s += 7;
1145 len = (int)(strchr(s, ' ') - s);
1146 label->initrd = malloc(len + 1);
1147 strncpy(label->initrd, s, len);
1148 label->initrd[len] = '\0';
1149
1150 break;
1151
1152 case T_INITRD:
1153 if (!label->initrd)
1154 err = parse_sliteral(c, &label->initrd);
1155 break;
1156
1157 case T_FDT:
1158 if (!label->fdt)
1159 err = parse_sliteral(c, &label->fdt);
1160 break;
1161
1162 case T_FDTDIR:
1163 if (!label->fdtdir)
1164 err = parse_sliteral(c, &label->fdtdir);
1165 break;
1166
1167 case T_FDTOVERLAYS:
1168 if (!label->fdtoverlays)
1169 err = parse_sliteral(c, &label->fdtoverlays);
1170 break;
1171
1172 case T_LOCALBOOT:
1173 label->localboot = 1;
1174 err = parse_integer(c, &label->localboot_val);
1175 break;
1176
1177 case T_IPAPPEND:
1178 err = parse_integer(c, &label->ipappend);
1179 break;
1180
1181 case T_EOL:
1182 break;
1183
1184 default:
1185
1186
1187
1188
1189
1190 *c = s;
1191 return 1;
1192 }
1193
1194 if (err < 0)
1195 return err;
1196 }
1197}
1198
1199
1200
1201
1202
1203
1204
1205#define MAX_NEST_LEVEL 16
1206
1207
1208
1209
1210
1211
1212
1213static int parse_pxefile_top(struct cmd_tbl *cmdtp, char *p, unsigned long base,
1214 struct pxe_menu *cfg, int nest_level)
1215{
1216 struct token t;
1217 char *s, *b, *label_name;
1218 int err;
1219
1220 b = p;
1221
1222 if (nest_level > MAX_NEST_LEVEL) {
1223 printf("Maximum nesting (%d) exceeded\n", MAX_NEST_LEVEL);
1224 return -EMLINK;
1225 }
1226
1227 while (1) {
1228 s = p;
1229
1230 get_token(&p, &t, L_KEYWORD);
1231
1232 err = 0;
1233 switch (t.type) {
1234 case T_MENU:
1235 cfg->prompt = 1;
1236 err = parse_menu(cmdtp, &p, cfg,
1237 base + ALIGN(strlen(b) + 1, 4),
1238 nest_level);
1239 break;
1240
1241 case T_TIMEOUT:
1242 err = parse_integer(&p, &cfg->timeout);
1243 break;
1244
1245 case T_LABEL:
1246 err = parse_label(&p, cfg);
1247 break;
1248
1249 case T_DEFAULT:
1250 case T_ONTIMEOUT:
1251 err = parse_sliteral(&p, &label_name);
1252
1253 if (label_name) {
1254 if (cfg->default_label)
1255 free(cfg->default_label);
1256
1257 cfg->default_label = label_name;
1258 }
1259
1260 break;
1261
1262 case T_INCLUDE:
1263 err = handle_include(cmdtp, &p,
1264 base + ALIGN(strlen(b), 4), cfg,
1265 nest_level + 1);
1266 break;
1267
1268 case T_PROMPT:
1269 eol_or_eof(&p);
1270 break;
1271
1272 case T_EOL:
1273 break;
1274
1275 case T_EOF:
1276 return 1;
1277
1278 default:
1279 printf("Ignoring unknown command: %.*s\n",
1280 (int)(p - s), s);
1281 eol_or_eof(&p);
1282 }
1283
1284 if (err < 0)
1285 return err;
1286 }
1287}
1288
1289
1290
1291
1292void destroy_pxe_menu(struct pxe_menu *cfg)
1293{
1294 struct list_head *pos, *n;
1295 struct pxe_label *label;
1296
1297 if (cfg->title)
1298 free(cfg->title);
1299
1300 if (cfg->default_label)
1301 free(cfg->default_label);
1302
1303 list_for_each_safe(pos, n, &cfg->labels) {
1304 label = list_entry(pos, struct pxe_label, list);
1305
1306 label_destroy(label);
1307 }
1308
1309 free(cfg);
1310}
1311
1312
1313
1314
1315
1316
1317
1318
1319
1320
1321struct pxe_menu *parse_pxefile(struct cmd_tbl *cmdtp, unsigned long menucfg)
1322{
1323 struct pxe_menu *cfg;
1324 char *buf;
1325 int r;
1326
1327 cfg = malloc(sizeof(struct pxe_menu));
1328
1329 if (!cfg)
1330 return NULL;
1331
1332 memset(cfg, 0, sizeof(struct pxe_menu));
1333
1334 INIT_LIST_HEAD(&cfg->labels);
1335
1336 buf = map_sysmem(menucfg, 0);
1337 r = parse_pxefile_top(cmdtp, buf, menucfg, cfg, 1);
1338 unmap_sysmem(buf);
1339
1340 if (r < 0) {
1341 destroy_pxe_menu(cfg);
1342 return NULL;
1343 }
1344
1345 return cfg;
1346}
1347
1348
1349
1350
1351
1352static struct menu *pxe_menu_to_menu(struct pxe_menu *cfg)
1353{
1354 struct pxe_label *label;
1355 struct list_head *pos;
1356 struct menu *m;
1357 int err;
1358 int i = 1;
1359 char *default_num = NULL;
1360
1361
1362
1363
1364 m = menu_create(cfg->title, DIV_ROUND_UP(cfg->timeout, 10),
1365 cfg->prompt, NULL, label_print, NULL, NULL);
1366
1367 if (!m)
1368 return NULL;
1369
1370 list_for_each(pos, &cfg->labels) {
1371 label = list_entry(pos, struct pxe_label, list);
1372
1373 sprintf(label->num, "%d", i++);
1374 if (menu_item_add(m, label->num, label) != 1) {
1375 menu_destroy(m);
1376 return NULL;
1377 }
1378 if (cfg->default_label &&
1379 (strcmp(label->name, cfg->default_label) == 0))
1380 default_num = label->num;
1381 }
1382
1383
1384
1385
1386
1387 if (default_num) {
1388 err = menu_default_set(m, default_num);
1389 if (err != 1) {
1390 if (err != -ENOENT) {
1391 menu_destroy(m);
1392 return NULL;
1393 }
1394
1395 printf("Missing default: %s\n", cfg->default_label);
1396 }
1397 }
1398
1399 return m;
1400}
1401
1402
1403
1404
1405static void boot_unattempted_labels(struct cmd_tbl *cmdtp, struct pxe_menu *cfg)
1406{
1407 struct list_head *pos;
1408 struct pxe_label *label;
1409
1410 list_for_each(pos, &cfg->labels) {
1411 label = list_entry(pos, struct pxe_label, list);
1412
1413 if (!label->attempted)
1414 label_boot(cmdtp, label);
1415 }
1416}
1417
1418
1419
1420
1421
1422
1423
1424
1425
1426
1427
1428
1429
1430void handle_pxe_menu(struct cmd_tbl *cmdtp, struct pxe_menu *cfg)
1431{
1432 void *choice;
1433 struct menu *m;
1434 int err;
1435
1436 if (IS_ENABLED(CONFIG_CMD_BMP)) {
1437
1438 if (cfg->bmp) {
1439 if (get_relfile(cmdtp, cfg->bmp, image_load_addr)) {
1440 if (CONFIG_IS_ENABLED(CMD_CLS))
1441 run_command("cls", 0);
1442 bmp_display(image_load_addr,
1443 BMP_ALIGN_CENTER, BMP_ALIGN_CENTER);
1444 } else {
1445 printf("Skipping background bmp %s for failure\n",
1446 cfg->bmp);
1447 }
1448 }
1449 }
1450
1451 m = pxe_menu_to_menu(cfg);
1452 if (!m)
1453 return;
1454
1455 err = menu_get_choice(m, &choice);
1456
1457 menu_destroy(m);
1458
1459
1460
1461
1462
1463
1464
1465
1466
1467
1468
1469
1470 if (err == 1) {
1471 err = label_boot(cmdtp, choice);
1472 if (!err)
1473 return;
1474 } else if (err != -ENOENT) {
1475 return;
1476 }
1477
1478 boot_unattempted_labels(cmdtp, cfg);
1479}
1480