MINI2440: Auto probe for SDRAM size
[u-boot-openmoko/mini2440.git] / common / main.c
blob17c3d2701e62c4da1289ff596677ea5ed7a8a4de
1 /*
2 * (C) Copyright 2000
3 * Wolfgang Denk, DENX Software Engineering, wd@denx.de.
5 * Add to readline cmdline-editing by
6 * (C) Copyright 2005
7 * JinHua Luo, GuangDong Linux Center, <luo.jinhua@gd-linux.com>
9 * See file CREDITS for list of people who contributed to this
10 * project.
12 * This program is free software; you can redistribute it and/or
13 * modify it under the terms of the GNU General Public License as
14 * published by the Free Software Foundation; either version 2 of
15 * the License, or (at your option) any later version.
17 * This program is distributed in the hope that it will be useful,
18 * but WITHOUT ANY WARRANTY; without even the implied warranty of
19 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
20 * GNU General Public License for more details.
22 * You should have received a copy of the GNU General Public License
23 * along with this program; if not, write to the Free Software
24 * Foundation, Inc., 59 Temple Place, Suite 330, Boston,
25 * MA 02111-1307 USA
28 /* #define DEBUG */
30 #include <common.h>
31 #include <watchdog.h>
32 #include <command.h>
33 #ifdef CONFIG_MODEM_SUPPORT
34 #include <malloc.h> /* for free() prototype */
35 #endif
37 #ifdef CFG_HUSH_PARSER
38 #include <hush.h>
39 #endif
41 #include <post.h>
43 #if defined(CONFIG_SILENT_CONSOLE) || defined(CONFIG_POST)
44 DECLARE_GLOBAL_DATA_PTR;
45 #endif
48 * Board-specific Platform code can reimplement show_boot_progress () if needed
50 void inline __show_boot_progress (int val) {}
51 void inline show_boot_progress (int val) __attribute__((weak, alias("__show_boot_progress")));
53 #if defined(CONFIG_BOOT_RETRY_TIME) && defined(CONFIG_RESET_TO_RETRY)
54 extern int do_reset (cmd_tbl_t *cmdtp, int flag, int argc, char *argv[]); /* for do_reset() prototype */
55 #endif
57 extern int do_bootd (cmd_tbl_t *cmdtp, int flag, int argc, char *argv[]);
60 #define MAX_DELAY_STOP_STR 32
62 #if defined(CONFIG_BOOTDELAY) && (CONFIG_BOOTDELAY >= 0)
63 static int abortboot(int);
64 #endif
66 #undef DEBUG_PARSER
68 char console_buffer[CFG_CBSIZE]; /* console I/O buffer */
69 int nobootdelay;
71 #ifndef CONFIG_CMDLINE_EDITING
72 static char * delete_char (char *buffer, char *p, int *colp, int *np, int plen);
73 static char erase_seq[] = "\b \b"; /* erase sequence */
74 static char tab_seq[] = " "; /* used to expand TABs */
75 #endif /* CONFIG_CMDLINE_EDITING */
77 #ifdef CONFIG_BOOT_RETRY_TIME
78 static uint64_t endtime = 0; /* must be set, default is instant timeout */
79 static int retry_time = -1; /* -1 so can call readline before main_loop */
80 #endif
82 #define endtick(seconds) (get_ticks() + (uint64_t)(seconds) * get_tbclk())
84 #ifndef CONFIG_BOOT_RETRY_MIN
85 #define CONFIG_BOOT_RETRY_MIN CONFIG_BOOT_RETRY_TIME
86 #endif
88 #ifdef CONFIG_MODEM_SUPPORT
89 int do_mdm_init = 0;
90 extern void mdm_init(void); /* defined in board.c */
91 #endif
93 #ifdef CFG_PREBOOT_OVERRIDE
94 extern char *preboot_override;
95 #endif
98 /***************************************************************************
99 * Watch for 'delay' seconds for autoboot stop or autoboot delay string.
100 * returns: 0 - no key string, allow autoboot
101 * 1 - got key string, abort
103 #if defined(CONFIG_BOOTDELAY) && (CONFIG_BOOTDELAY >= 0)
104 # if defined(CONFIG_AUTOBOOT_KEYED)
105 static __inline__ int abortboot(int bootdelay)
107 int abort = 0;
108 uint64_t etime = endtick(bootdelay);
109 struct {
110 char* str;
111 u_int len;
112 int retry;
114 delaykey [] = {
115 { str: getenv ("bootdelaykey"), retry: 1 },
116 { str: getenv ("bootdelaykey2"), retry: 1 },
117 { str: getenv ("bootstopkey"), retry: 0 },
118 { str: getenv ("bootstopkey2"), retry: 0 },
121 char presskey [MAX_DELAY_STOP_STR];
122 u_int presskey_len = 0;
123 u_int presskey_max = 0;
124 u_int i;
126 # ifdef CONFIG_AUTOBOOT_PROMPT
127 printf(CONFIG_AUTOBOOT_PROMPT, bootdelay);
128 # endif
130 # ifdef CONFIG_AUTOBOOT_DELAY_STR
131 if (delaykey[0].str == NULL)
132 delaykey[0].str = CONFIG_AUTOBOOT_DELAY_STR;
133 # endif
134 # ifdef CONFIG_AUTOBOOT_DELAY_STR2
135 if (delaykey[1].str == NULL)
136 delaykey[1].str = CONFIG_AUTOBOOT_DELAY_STR2;
137 # endif
138 # ifdef CONFIG_AUTOBOOT_STOP_STR
139 if (delaykey[2].str == NULL)
140 delaykey[2].str = CONFIG_AUTOBOOT_STOP_STR;
141 # endif
142 # ifdef CONFIG_AUTOBOOT_STOP_STR2
143 if (delaykey[3].str == NULL)
144 delaykey[3].str = CONFIG_AUTOBOOT_STOP_STR2;
145 # endif
147 for (i = 0; i < sizeof(delaykey) / sizeof(delaykey[0]); i ++) {
148 delaykey[i].len = delaykey[i].str == NULL ?
149 0 : strlen (delaykey[i].str);
150 delaykey[i].len = delaykey[i].len > MAX_DELAY_STOP_STR ?
151 MAX_DELAY_STOP_STR : delaykey[i].len;
153 presskey_max = presskey_max > delaykey[i].len ?
154 presskey_max : delaykey[i].len;
156 # if DEBUG_BOOTKEYS
157 printf("%s key:<%s>\n",
158 delaykey[i].retry ? "delay" : "stop",
159 delaykey[i].str ? delaykey[i].str : "NULL");
160 # endif
163 /* In order to keep up with incoming data, check timeout only
164 * when catch up.
166 while (!abort && get_ticks() <= etime) {
167 for (i = 0; i < sizeof(delaykey) / sizeof(delaykey[0]); i ++) {
168 if (delaykey[i].len > 0 &&
169 presskey_len >= delaykey[i].len &&
170 memcmp (presskey + presskey_len - delaykey[i].len,
171 delaykey[i].str,
172 delaykey[i].len) == 0) {
173 # if DEBUG_BOOTKEYS
174 printf("got %skey\n",
175 delaykey[i].retry ? "delay" : "stop");
176 # endif
178 # ifdef CONFIG_BOOT_RETRY_TIME
179 /* don't retry auto boot */
180 if (! delaykey[i].retry)
181 retry_time = -1;
182 # endif
183 abort = 1;
187 if (tstc()) {
188 if (presskey_len < presskey_max) {
189 presskey [presskey_len ++] = getc();
191 else {
192 for (i = 0; i < presskey_max - 1; i ++)
193 presskey [i] = presskey [i + 1];
195 presskey [i] = getc();
199 # if DEBUG_BOOTKEYS
200 if (!abort)
201 puts("key timeout\n");
202 # endif
204 #ifdef CONFIG_SILENT_CONSOLE
205 if (abort)
206 gd->flags &= ~GD_FLG_SILENT;
207 #endif
209 return abort;
212 # else /* !defined(CONFIG_AUTOBOOT_KEYED) */
214 #ifdef CONFIG_MENUKEY
215 static int menukey = 0;
216 #endif
218 static __inline__ int abortboot(int bootdelay)
220 int abort = 0;
222 #ifdef CONFIG_MENUPROMPT
223 printf(CONFIG_MENUPROMPT, bootdelay);
224 #else
225 printf("Hit any key to stop autoboot: %2d ", bootdelay);
226 #endif
228 #if defined CONFIG_ZERO_BOOTDELAY_CHECK
230 * Check if key already pressed
231 * Don't check if bootdelay < 0
233 if (bootdelay >= 0) {
234 if (tstc()) { /* we got a key press */
235 (void) getc(); /* consume input */
236 puts ("\b\b\b 0");
237 abort = 1; /* don't auto boot */
240 #endif
242 while ((bootdelay > 0) && (!abort)) {
243 int i;
245 --bootdelay;
246 /* delay 100 * 10ms */
247 for (i=0; !abort && i<100; ++i) {
248 if (tstc()) { /* we got a key press */
249 abort = 1; /* don't auto boot */
250 bootdelay = 0; /* no more delay */
251 # ifdef CONFIG_MENUKEY
252 menukey = getc();
253 # else
254 (void) getc(); /* consume input */
255 # endif
256 break;
258 udelay(10000);
261 printf("\b\b\b%2d ", bootdelay);
264 putc('\n');
266 #ifdef CONFIG_SILENT_CONSOLE
267 if (abort)
268 gd->flags &= ~GD_FLG_SILENT;
269 #endif
271 return abort;
273 # endif /* CONFIG_AUTOBOOT_KEYED */
274 #endif /* CONFIG_BOOTDELAY >= 0 */
276 /****************************************************************************/
278 void main_loop (void)
280 #ifndef CFG_HUSH_PARSER
281 static char lastcommand[CFG_CBSIZE] = { 0, };
282 int len;
283 int rc = 1;
284 int flag;
285 #endif
287 #if defined(CONFIG_BOOTDELAY) && (CONFIG_BOOTDELAY >= 0)
288 char *s;
289 int bootdelay;
290 #endif
291 #if defined(CONFIG_PREBOOT) || defined(CFG_PREBOOT_OVERRIDE)
292 char *p = NULL;
293 #endif
294 #ifdef CONFIG_BOOTCOUNT_LIMIT
295 unsigned long bootcount = 0;
296 unsigned long bootlimit = 0;
297 char *bcs;
298 char bcs_set[16];
299 #endif /* CONFIG_BOOTCOUNT_LIMIT */
301 #if defined(CONFIG_VFD) && defined(VFD_TEST_LOGO)
302 ulong bmp = 0; /* default bitmap */
303 extern int trab_vfd (ulong bitmap);
305 #ifdef CONFIG_MODEM_SUPPORT
306 if (do_mdm_init)
307 bmp = 1; /* alternate bitmap */
308 #endif
309 trab_vfd (bmp);
310 #endif /* CONFIG_VFD && VFD_TEST_LOGO */
312 #ifdef CONFIG_BOOTCOUNT_LIMIT
313 bootcount = bootcount_load();
314 bootcount++;
315 bootcount_store (bootcount);
316 sprintf (bcs_set, "%lu", bootcount);
317 setenv ("bootcount", bcs_set);
318 bcs = getenv ("bootlimit");
319 bootlimit = bcs ? simple_strtoul (bcs, NULL, 10) : 0;
320 #endif /* CONFIG_BOOTCOUNT_LIMIT */
322 #ifdef CONFIG_MODEM_SUPPORT
323 debug ("DEBUG: main_loop: do_mdm_init=%d\n", do_mdm_init);
324 if (do_mdm_init) {
325 char *str = strdup(getenv("mdm_cmd"));
326 setenv ("preboot", str); /* set or delete definition */
327 if (str != NULL)
328 free (str);
329 mdm_init(); /* wait for modem connection */
331 #endif /* CONFIG_MODEM_SUPPORT */
333 #ifdef CONFIG_VERSION_VARIABLE
335 extern char version_string[];
337 setenv ("ver", version_string); /* set version variable */
339 #endif /* CONFIG_VERSION_VARIABLE */
341 #ifdef CFG_HUSH_PARSER
342 u_boot_hush_start ();
343 #endif
345 #ifdef CONFIG_AUTO_COMPLETE
346 install_auto_complete();
347 #endif
349 #if defined(CONFIG_PREBOOT) || defined(CFG_PREBOOT_OVERRIDE)
350 #ifdef CONFIG_PREBOOT
351 p = getenv ("preboot");
352 #endif
353 #ifdef CFG_PREBOOT_OVERRIDE
354 if (preboot_override) {
355 /* for convenience, preboot_override may end in \n, not \0 */
356 p = strchr(preboot_override, '\n');
357 if (p)
358 *p = 0;
359 /* make sure we can overwrite the load area if we want to */
360 p = strdup(preboot_override);
361 /* clean the image in case we want to flash it */
362 preboot_override = NULL;
364 #endif /* CFG_PREBOOT_OVERRIDE */
365 if (p) {
366 # ifdef CONFIG_AUTOBOOT_KEYED
367 int prev = disable_ctrlc(1); /* disable Control C checking */
368 # endif
370 # ifndef CFG_HUSH_PARSER
371 run_command (p, 0);
372 # else
373 parse_string_outer(p, FLAG_PARSE_SEMICOLON |
374 FLAG_EXIT_FROM_LOOP);
375 # endif
377 # ifdef CONFIG_AUTOBOOT_KEYED
378 disable_ctrlc(prev); /* restore Control C checking */
379 # endif
381 #endif /* CONFIG_PREBOOT || CFG_PREBOOT_OVERRIDE */
383 #if defined(CONFIG_BOOTDELAY) && (CONFIG_BOOTDELAY >= 0)
384 s = getenv ("bootdelay");
385 bootdelay = s ? (int)simple_strtol(s, NULL, 10) : CONFIG_BOOTDELAY;
387 debug ("### main_loop entered: bootdelay=%d\n\n", bootdelay);
389 # ifdef CONFIG_BOOT_RETRY_TIME
390 init_cmd_timeout ();
391 # endif /* CONFIG_BOOT_RETRY_TIME */
393 #ifdef CONFIG_POST
394 if (gd->flags & GD_FLG_POSTFAIL) {
395 s = getenv("failbootcmd");
397 else
398 #endif /* CONFIG_POST */
399 #ifdef CONFIG_BOOTCOUNT_LIMIT
400 if (bootlimit && (bootcount > bootlimit)) {
401 printf ("Warning: Bootlimit (%u) exceeded. Using altbootcmd.\n",
402 (unsigned)bootlimit);
403 s = getenv ("altbootcmd");
405 else
406 #endif /* CONFIG_BOOTCOUNT_LIMIT */
407 s = getenv ("bootcmd");
409 debug ("### main_loop: bootcmd=\"%s\"\n", s ? s : "<UNDEFINED>");
411 if (!nobootdelay && bootdelay >= 0 && s && !abortboot (bootdelay)) {
412 # ifdef CONFIG_AUTOBOOT_KEYED
413 int prev = disable_ctrlc(1); /* disable Control C checking */
414 # endif
416 # ifndef CFG_HUSH_PARSER
417 run_command (s, 0);
418 # else
419 parse_string_outer(s, FLAG_PARSE_SEMICOLON |
420 FLAG_EXIT_FROM_LOOP);
421 # endif
423 # ifdef CONFIG_AUTOBOOT_KEYED
424 disable_ctrlc(prev); /* restore Control C checking */
425 # endif
428 # ifdef CONFIG_MENUKEY
429 if (menukey == CONFIG_MENUKEY) {
430 s = getenv("menucmd");
431 if (s) {
432 # ifndef CFG_HUSH_PARSER
433 run_command (s, 0);
434 # else
435 parse_string_outer(s, FLAG_PARSE_SEMICOLON |
436 FLAG_EXIT_FROM_LOOP);
437 # endif
440 #endif /* CONFIG_MENUKEY */
441 #endif /* CONFIG_BOOTDELAY */
443 #ifdef CONFIG_AMIGAONEG3SE
445 extern void video_banner(void);
446 video_banner();
448 #endif
451 * Main Loop for Monitor Command Processing
453 #ifdef CFG_HUSH_PARSER
454 parse_file_outer();
455 /* This point is never reached */
456 for (;;);
457 #else
458 for (;;) {
459 #ifdef CONFIG_BOOT_RETRY_TIME
460 if (rc >= 0) {
461 /* Saw enough of a valid command to
462 * restart the timeout.
464 reset_cmd_timeout();
466 #endif
467 len = readline (CFG_PROMPT);
469 flag = 0; /* assume no special flags for now */
470 if (len > 0)
471 strcpy (lastcommand, console_buffer);
472 else if (len == 0)
473 flag |= CMD_FLAG_REPEAT;
474 #ifdef CONFIG_BOOT_RETRY_TIME
475 else if (len == -2) {
476 /* -2 means timed out, retry autoboot
478 puts ("\nTimed out waiting for command\n");
479 # ifdef CONFIG_RESET_TO_RETRY
480 /* Reinit board to run initialization code again */
481 do_reset (NULL, 0, 0, NULL);
482 # else
483 return; /* retry autoboot */
484 # endif
486 #endif
488 if (len == -1)
489 puts ("<INTERRUPT>\n");
490 else
491 rc = run_command (lastcommand, flag);
493 if (rc <= 0) {
494 /* invalid command or not repeatable, forget it */
495 lastcommand[0] = 0;
498 #endif /*CFG_HUSH_PARSER*/
501 #ifdef CONFIG_BOOT_RETRY_TIME
502 /***************************************************************************
503 * initialize command line timeout
505 void init_cmd_timeout(void)
507 char *s = getenv ("bootretry");
509 if (s != NULL)
510 retry_time = (int)simple_strtol(s, NULL, 10);
511 else
512 retry_time = CONFIG_BOOT_RETRY_TIME;
514 if (retry_time >= 0 && retry_time < CONFIG_BOOT_RETRY_MIN)
515 retry_time = CONFIG_BOOT_RETRY_MIN;
518 /***************************************************************************
519 * reset command line timeout to retry_time seconds
521 void reset_cmd_timeout(void)
523 endtime = endtick(retry_time);
525 #endif
527 #ifdef CONFIG_CMDLINE_EDITING
530 * cmdline-editing related codes from vivi.
531 * Author: Janghoon Lyu <nandy@mizi.com>
534 #define putnstr(str,n) do { \
535 printf ("%.*s", n, str); \
536 } while (0)
538 #define CTL_CH(c) ((c) - 'a' + 1)
540 #define MAX_CMDBUF_SIZE 256
542 #define CTL_BACKSPACE ('\b')
543 #define DEL ((char)255)
544 #define DEL7 ((char)127)
545 #define CREAD_HIST_CHAR ('!')
547 #define getcmd_putch(ch) putc(ch)
548 #define getcmd_getch() getc()
549 #define getcmd_cbeep() getcmd_putch('\a')
551 #define HIST_MAX 20
552 #define HIST_SIZE MAX_CMDBUF_SIZE
554 static int hist_max = 0;
555 static int hist_add_idx = 0;
556 static int hist_cur = -1;
557 unsigned hist_num = 0;
559 char* hist_list[HIST_MAX];
560 char hist_lines[HIST_MAX][HIST_SIZE];
562 #define add_idx_minus_one() ((hist_add_idx == 0) ? hist_max : hist_add_idx-1)
564 static void hist_init(void)
566 int i;
568 hist_max = 0;
569 hist_add_idx = 0;
570 hist_cur = -1;
571 hist_num = 0;
573 for (i = 0; i < HIST_MAX; i++) {
574 hist_list[i] = hist_lines[i];
575 hist_list[i][0] = '\0';
579 static void cread_add_to_hist(char *line)
581 strcpy(hist_list[hist_add_idx], line);
583 if (++hist_add_idx >= HIST_MAX)
584 hist_add_idx = 0;
586 if (hist_add_idx > hist_max)
587 hist_max = hist_add_idx;
589 hist_num++;
592 static char* hist_prev(void)
594 char *ret;
595 int old_cur;
597 if (hist_cur < 0)
598 return NULL;
600 old_cur = hist_cur;
601 if (--hist_cur < 0)
602 hist_cur = hist_max;
604 if (hist_cur == hist_add_idx) {
605 hist_cur = old_cur;
606 ret = NULL;
607 } else
608 ret = hist_list[hist_cur];
610 return (ret);
613 static char* hist_next(void)
615 char *ret;
617 if (hist_cur < 0)
618 return NULL;
620 if (hist_cur == hist_add_idx)
621 return NULL;
623 if (++hist_cur > hist_max)
624 hist_cur = 0;
626 if (hist_cur == hist_add_idx) {
627 ret = "";
628 } else
629 ret = hist_list[hist_cur];
631 return (ret);
634 #ifndef CONFIG_CMDLINE_EDITING
635 static void cread_print_hist_list(void)
637 int i;
638 unsigned long n;
640 n = hist_num - hist_max;
642 i = hist_add_idx + 1;
643 while (1) {
644 if (i > hist_max)
645 i = 0;
646 if (i == hist_add_idx)
647 break;
648 printf("%s\n", hist_list[i]);
649 n++;
650 i++;
653 #endif /* CONFIG_CMDLINE_EDITING */
655 #define BEGINNING_OF_LINE() { \
656 while (num) { \
657 getcmd_putch(CTL_BACKSPACE); \
658 num--; \
662 #define ERASE_TO_EOL() { \
663 if (num < eol_num) { \
664 int tmp; \
665 for (tmp = num; tmp < eol_num; tmp++) \
666 getcmd_putch(' '); \
667 while (tmp-- > num) \
668 getcmd_putch(CTL_BACKSPACE); \
669 eol_num = num; \
673 #define REFRESH_TO_EOL() { \
674 if (num < eol_num) { \
675 wlen = eol_num - num; \
676 putnstr(buf + num, wlen); \
677 num = eol_num; \
681 static void cread_add_char(char ichar, int insert, unsigned long *num,
682 unsigned long *eol_num, char *buf, unsigned long len)
684 unsigned long wlen;
686 /* room ??? */
687 if (insert || *num == *eol_num) {
688 if (*eol_num > len - 1) {
689 getcmd_cbeep();
690 return;
692 (*eol_num)++;
695 if (insert) {
696 wlen = *eol_num - *num;
697 if (wlen > 1) {
698 memmove(&buf[*num+1], &buf[*num], wlen-1);
701 buf[*num] = ichar;
702 putnstr(buf + *num, wlen);
703 (*num)++;
704 while (--wlen) {
705 getcmd_putch(CTL_BACKSPACE);
707 } else {
708 /* echo the character */
709 wlen = 1;
710 buf[*num] = ichar;
711 putnstr(buf + *num, wlen);
712 (*num)++;
716 static void cread_add_str(char *str, int strsize, int insert, unsigned long *num,
717 unsigned long *eol_num, char *buf, unsigned long len)
719 while (strsize--) {
720 cread_add_char(*str, insert, num, eol_num, buf, len);
721 str++;
725 static int cread_line(const char *const prompt, char *buf, unsigned int *len)
727 unsigned long num = 0;
728 unsigned long eol_num = 0;
729 unsigned long rlen;
730 unsigned long wlen;
731 char ichar;
732 int insert = 1;
733 int esc_len = 0;
734 int rc = 0;
735 char esc_save[8];
737 while (1) {
738 rlen = 1;
739 #ifdef CONFIG_BOOT_RETRY_TIME
740 while (!tstc()) { /* while no incoming data */
741 if (retry_time >= 0 && get_ticks() > endtime)
742 return (-2); /* timed out */
744 #endif
746 ichar = getcmd_getch();
748 if ((ichar == '\n') || (ichar == '\r')) {
749 putc('\n');
750 break;
754 * handle standard linux xterm esc sequences for arrow key, etc.
756 if (esc_len != 0) {
757 if (esc_len == 1) {
758 if (ichar == '[') {
759 esc_save[esc_len] = ichar;
760 esc_len = 2;
761 } else {
762 cread_add_str(esc_save, esc_len, insert,
763 &num, &eol_num, buf, *len);
764 esc_len = 0;
766 continue;
769 switch (ichar) {
771 case 'D': /* <- key */
772 ichar = CTL_CH('b');
773 esc_len = 0;
774 break;
775 case 'C': /* -> key */
776 ichar = CTL_CH('f');
777 esc_len = 0;
778 break; /* pass off to ^F handler */
779 case 'H': /* Home key */
780 ichar = CTL_CH('a');
781 esc_len = 0;
782 break; /* pass off to ^A handler */
783 case 'A': /* up arrow */
784 ichar = CTL_CH('p');
785 esc_len = 0;
786 break; /* pass off to ^P handler */
787 case 'B': /* down arrow */
788 ichar = CTL_CH('n');
789 esc_len = 0;
790 break; /* pass off to ^N handler */
791 default:
792 esc_save[esc_len++] = ichar;
793 cread_add_str(esc_save, esc_len, insert,
794 &num, &eol_num, buf, *len);
795 esc_len = 0;
796 continue;
800 switch (ichar) {
801 case 0x1b:
802 if (esc_len == 0) {
803 esc_save[esc_len] = ichar;
804 esc_len = 1;
805 } else {
806 puts("impossible condition #876\n");
807 esc_len = 0;
809 break;
811 case CTL_CH('a'):
812 BEGINNING_OF_LINE();
813 break;
814 case CTL_CH('c'): /* ^C - break */
815 *buf = '\0'; /* discard input */
816 return (-1);
817 case CTL_CH('f'):
818 if (num < eol_num) {
819 getcmd_putch(buf[num]);
820 num++;
822 break;
823 case CTL_CH('b'):
824 if (num) {
825 getcmd_putch(CTL_BACKSPACE);
826 num--;
828 break;
829 case CTL_CH('d'):
830 if (num < eol_num) {
831 wlen = eol_num - num - 1;
832 if (wlen) {
833 memmove(&buf[num], &buf[num+1], wlen);
834 putnstr(buf + num, wlen);
837 getcmd_putch(' ');
838 do {
839 getcmd_putch(CTL_BACKSPACE);
840 } while (wlen--);
841 eol_num--;
843 break;
844 case CTL_CH('k'):
845 ERASE_TO_EOL();
846 break;
847 case CTL_CH('e'):
848 REFRESH_TO_EOL();
849 break;
850 case CTL_CH('o'):
851 insert = !insert;
852 break;
853 case CTL_CH('x'):
854 case CTL_CH('u'):
855 BEGINNING_OF_LINE();
856 ERASE_TO_EOL();
857 break;
858 case DEL:
859 case DEL7:
860 case 8:
861 if (num) {
862 wlen = eol_num - num;
863 num--;
864 memmove(&buf[num], &buf[num+1], wlen);
865 getcmd_putch(CTL_BACKSPACE);
866 putnstr(buf + num, wlen);
867 getcmd_putch(' ');
868 do {
869 getcmd_putch(CTL_BACKSPACE);
870 } while (wlen--);
871 eol_num--;
873 break;
874 case CTL_CH('p'):
875 case CTL_CH('n'):
877 char * hline;
879 esc_len = 0;
881 if (ichar == CTL_CH('p'))
882 hline = hist_prev();
883 else
884 hline = hist_next();
886 if (!hline) {
887 getcmd_cbeep();
888 continue;
891 /* nuke the current line */
892 /* first, go home */
893 BEGINNING_OF_LINE();
895 /* erase to end of line */
896 ERASE_TO_EOL();
898 /* copy new line into place and display */
899 strcpy(buf, hline);
900 eol_num = strlen(buf);
901 REFRESH_TO_EOL();
902 continue;
904 #ifdef CONFIG_AUTO_COMPLETE
905 case '\t': {
906 int num2, col;
908 /* do not autocomplete when in the middle */
909 if (num < eol_num) {
910 getcmd_cbeep();
911 break;
914 buf[num] = '\0';
915 col = strlen(prompt) + eol_num;
916 num2 = num;
917 if (cmd_auto_complete(prompt, buf, &num2, &col)) {
918 col = num2 - num;
919 num += col;
920 eol_num += col;
922 break;
924 #endif
925 default:
926 cread_add_char(ichar, insert, &num, &eol_num, buf, *len);
927 break;
930 *len = eol_num;
931 buf[eol_num] = '\0'; /* lose the newline */
933 if (buf[0] && buf[0] != CREAD_HIST_CHAR)
934 cread_add_to_hist(buf);
935 hist_cur = hist_add_idx;
937 return (rc);
940 #endif /* CONFIG_CMDLINE_EDITING */
942 /****************************************************************************/
945 * Prompt for input and read a line.
946 * If CONFIG_BOOT_RETRY_TIME is defined and retry_time >= 0,
947 * time out when time goes past endtime (timebase time in ticks).
948 * Return: number of read characters
949 * -1 if break
950 * -2 if timed out
952 int readline (const char *const prompt)
954 return readline_into_buffer(prompt, console_buffer);
958 int readline_into_buffer (const char *const prompt, char * buffer)
960 char *p = buffer;
961 #ifdef CONFIG_CMDLINE_EDITING
962 unsigned int len=MAX_CMDBUF_SIZE;
963 int rc;
964 static int initted = 0;
966 if (!initted) {
967 hist_init();
968 initted = 1;
971 puts (prompt);
973 rc = cread_line(prompt, p, &len);
974 return rc < 0 ? rc : len;
975 #else
976 char * p_buf = p;
977 int n = 0; /* buffer index */
978 int plen = 0; /* prompt length */
979 int col; /* output column cnt */
980 char c;
982 /* print prompt */
983 if (prompt) {
984 plen = strlen (prompt);
985 puts (prompt);
987 col = plen;
989 for (;;) {
990 #ifdef CONFIG_BOOT_RETRY_TIME
991 while (!tstc()) { /* while no incoming data */
992 if (retry_time >= 0 && get_ticks() > endtime)
993 return (-2); /* timed out */
995 #endif
996 WATCHDOG_RESET(); /* Trigger watchdog, if needed */
998 #ifdef CONFIG_SHOW_ACTIVITY
999 while (!tstc()) {
1000 extern void show_activity(int arg);
1001 show_activity(0);
1003 #endif
1004 c = getc();
1007 * Special character handling
1009 switch (c) {
1010 case '\r': /* Enter */
1011 case '\n':
1012 *p = '\0';
1013 puts ("\r\n");
1014 return (p - p_buf);
1016 case '\0': /* nul */
1017 continue;
1019 case 0x03: /* ^C - break */
1020 p_buf[0] = '\0'; /* discard input */
1021 return (-1);
1023 case 0x15: /* ^U - erase line */
1024 while (col > plen) {
1025 puts (erase_seq);
1026 --col;
1028 p = p_buf;
1029 n = 0;
1030 continue;
1032 case 0x17: /* ^W - erase word */
1033 p=delete_char(p_buf, p, &col, &n, plen);
1034 while ((n > 0) && (*p != ' ')) {
1035 p=delete_char(p_buf, p, &col, &n, plen);
1037 continue;
1039 case 0x08: /* ^H - backspace */
1040 case 0x7F: /* DEL - backspace */
1041 p=delete_char(p_buf, p, &col, &n, plen);
1042 continue;
1044 default:
1046 * Must be a normal character then
1048 if (n < CFG_CBSIZE-2) {
1049 if (c == '\t') { /* expand TABs */
1050 #ifdef CONFIG_AUTO_COMPLETE
1051 /* if auto completion triggered just continue */
1052 *p = '\0';
1053 if (cmd_auto_complete(prompt, console_buffer, &n, &col)) {
1054 p = p_buf + n; /* reset */
1055 continue;
1057 #endif
1058 puts (tab_seq+(col&07));
1059 col += 8 - (col&07);
1060 } else {
1061 ++col; /* echo input */
1062 putc (c);
1064 *p++ = c;
1065 ++n;
1066 } else { /* Buffer full */
1067 putc ('\a');
1071 #endif /* CONFIG_CMDLINE_EDITING */
1074 /****************************************************************************/
1076 #ifndef CONFIG_CMDLINE_EDITING
1077 static char * delete_char (char *buffer, char *p, int *colp, int *np, int plen)
1079 char *s;
1081 if (*np == 0) {
1082 return (p);
1085 if (*(--p) == '\t') { /* will retype the whole line */
1086 while (*colp > plen) {
1087 puts (erase_seq);
1088 (*colp)--;
1090 for (s=buffer; s<p; ++s) {
1091 if (*s == '\t') {
1092 puts (tab_seq+((*colp) & 07));
1093 *colp += 8 - ((*colp) & 07);
1094 } else {
1095 ++(*colp);
1096 putc (*s);
1099 } else {
1100 puts (erase_seq);
1101 (*colp)--;
1103 (*np)--;
1104 return (p);
1106 #endif /* CONFIG_CMDLINE_EDITING */
1108 /****************************************************************************/
1110 int parse_line (char *line, char *argv[])
1112 int nargs = 0;
1114 #ifdef DEBUG_PARSER
1115 printf ("parse_line: \"%s\"\n", line);
1116 #endif
1117 while (nargs < CFG_MAXARGS) {
1119 /* skip any white space */
1120 while ((*line == ' ') || (*line == '\t')) {
1121 ++line;
1124 if (*line == '\0') { /* end of line, no more args */
1125 argv[nargs] = NULL;
1126 #ifdef DEBUG_PARSER
1127 printf ("parse_line: nargs=%d\n", nargs);
1128 #endif
1129 return (nargs);
1132 argv[nargs++] = line; /* begin of argument string */
1134 /* find end of string */
1135 while (*line && (*line != ' ') && (*line != '\t')) {
1136 ++line;
1139 if (*line == '\0') { /* end of line, no more args */
1140 argv[nargs] = NULL;
1141 #ifdef DEBUG_PARSER
1142 printf ("parse_line: nargs=%d\n", nargs);
1143 #endif
1144 return (nargs);
1147 *line++ = '\0'; /* terminate current arg */
1150 printf ("** Too many args (max. %d) **\n", CFG_MAXARGS);
1152 #ifdef DEBUG_PARSER
1153 printf ("parse_line: nargs=%d\n", nargs);
1154 #endif
1155 return (nargs);
1158 /****************************************************************************/
1160 static void process_macros (const char *input, char *output)
1162 char c, prev;
1163 const char *varname_start = NULL;
1164 int inputcnt = strlen (input);
1165 int outputcnt = CFG_CBSIZE;
1166 int state = 0; /* 0 = waiting for '$' */
1168 /* 1 = waiting for '(' or '{' */
1169 /* 2 = waiting for ')' or '}' */
1170 /* 3 = waiting for ''' */
1171 #ifdef DEBUG_PARSER
1172 char *output_start = output;
1174 printf ("[PROCESS_MACROS] INPUT len %d: \"%s\"\n", strlen (input),
1175 input);
1176 #endif
1178 prev = '\0'; /* previous character */
1180 while (inputcnt && outputcnt) {
1181 c = *input++;
1182 inputcnt--;
1184 if (state != 3) {
1185 /* remove one level of escape characters */
1186 if ((c == '\\') && (prev != '\\')) {
1187 if (inputcnt-- == 0)
1188 break;
1189 prev = c;
1190 c = *input++;
1194 switch (state) {
1195 case 0: /* Waiting for (unescaped) $ */
1196 if ((c == '\'') && (prev != '\\')) {
1197 state = 3;
1198 break;
1200 if ((c == '$') && (prev != '\\')) {
1201 state++;
1202 } else {
1203 *(output++) = c;
1204 outputcnt--;
1206 break;
1207 case 1: /* Waiting for ( */
1208 if (c == '(' || c == '{') {
1209 state++;
1210 varname_start = input;
1211 } else {
1212 state = 0;
1213 *(output++) = '$';
1214 outputcnt--;
1216 if (outputcnt) {
1217 *(output++) = c;
1218 outputcnt--;
1221 break;
1222 case 2: /* Waiting for ) */
1223 if (c == ')' || c == '}') {
1224 int i;
1225 char envname[CFG_CBSIZE], *envval;
1226 int envcnt = input - varname_start - 1; /* Varname # of chars */
1228 /* Get the varname */
1229 for (i = 0; i < envcnt; i++) {
1230 envname[i] = varname_start[i];
1232 envname[i] = 0;
1234 /* Get its value */
1235 envval = getenv (envname);
1237 /* Copy into the line if it exists */
1238 if (envval != NULL)
1239 while ((*envval) && outputcnt) {
1240 *(output++) = *(envval++);
1241 outputcnt--;
1243 /* Look for another '$' */
1244 state = 0;
1246 break;
1247 case 3: /* Waiting for ' */
1248 if ((c == '\'') && (prev != '\\')) {
1249 state = 0;
1250 } else {
1251 *(output++) = c;
1252 outputcnt--;
1254 break;
1256 prev = c;
1259 if (outputcnt)
1260 *output = 0;
1261 else
1262 *(output - 1) = 0;
1264 #ifdef DEBUG_PARSER
1265 printf ("[PROCESS_MACROS] OUTPUT len %d: \"%s\"\n",
1266 strlen (output_start), output_start);
1267 #endif
1270 /****************************************************************************
1271 * returns:
1272 * 1 - command executed, repeatable
1273 * 0 - command executed but not repeatable, interrupted commands are
1274 * always considered not repeatable
1275 * -1 - not executed (unrecognized, bootd recursion or too many args)
1276 * (If cmd is NULL or "" or longer than CFG_CBSIZE-1 it is
1277 * considered unrecognized)
1279 * WARNING:
1281 * We must create a temporary copy of the command since the command we get
1282 * may be the result from getenv(), which returns a pointer directly to
1283 * the environment data, which may change magicly when the command we run
1284 * creates or modifies environment variables (like "bootp" does).
1287 int run_command (const char *cmd, int flag)
1289 cmd_tbl_t *cmdtp;
1290 char cmdbuf[CFG_CBSIZE]; /* working copy of cmd */
1291 char *token; /* start of token in cmdbuf */
1292 char *sep; /* end of token (separator) in cmdbuf */
1293 char finaltoken[CFG_CBSIZE];
1294 char *str = cmdbuf;
1295 char *argv[CFG_MAXARGS + 1]; /* NULL terminated */
1296 int argc, inquotes;
1297 int repeatable = 1;
1298 int rc = 0;
1300 #ifdef DEBUG_PARSER
1301 printf ("[RUN_COMMAND] cmd[%p]=\"", cmd);
1302 puts (cmd ? cmd : "NULL"); /* use puts - string may be loooong */
1303 puts ("\"\n");
1304 #endif
1306 clear_ctrlc(); /* forget any previous Control C */
1308 if (!cmd || !*cmd) {
1309 return -1; /* empty command */
1312 if (strlen(cmd) >= CFG_CBSIZE) {
1313 puts ("## Command too long!\n");
1314 return -1;
1317 strcpy (cmdbuf, cmd);
1319 /* Process separators and check for invalid
1320 * repeatable commands
1323 #ifdef DEBUG_PARSER
1324 printf ("[PROCESS_SEPARATORS] %s\n", cmd);
1325 #endif
1326 while (*str) {
1329 * Find separator, or string end
1330 * Allow simple escape of ';' by writing "\;"
1332 for (inquotes = 0, sep = str; *sep; sep++) {
1333 if ((*sep=='\'') &&
1334 (*(sep-1) != '\\'))
1335 inquotes=!inquotes;
1337 if (!inquotes &&
1338 (*sep == ';') && /* separator */
1339 ( sep != str) && /* past string start */
1340 (*(sep-1) != '\\')) /* and NOT escaped */
1341 break;
1345 * Limit the token to data between separators
1347 token = str;
1348 if (*sep) {
1349 str = sep + 1; /* start of command for next pass */
1350 *sep = '\0';
1352 else
1353 str = sep; /* no more commands for next pass */
1354 #ifdef DEBUG_PARSER
1355 printf ("token: \"%s\"\n", token);
1356 #endif
1358 /* find macros in this token and replace them */
1359 process_macros (token, finaltoken);
1361 /* Extract arguments */
1362 if ((argc = parse_line (finaltoken, argv)) == 0) {
1363 rc = -1; /* no command at all */
1364 continue;
1367 /* Look up command in command table */
1368 if ((cmdtp = find_cmd(argv[0])) == NULL) {
1369 printf ("Unknown command '%s' - try 'help'\n", argv[0]);
1370 rc = -1; /* give up after bad command */
1371 continue;
1374 /* found - check max args */
1375 if (argc > cmdtp->maxargs) {
1376 printf ("Usage:\n%s\n", cmdtp->usage);
1377 rc = -1;
1378 continue;
1381 #if defined(CONFIG_CMD_BOOTD)
1382 /* avoid "bootd" recursion */
1383 if (cmdtp->cmd == do_bootd) {
1384 #ifdef DEBUG_PARSER
1385 printf ("[%s]\n", finaltoken);
1386 #endif
1387 if (flag & CMD_FLAG_BOOTD) {
1388 puts ("'bootd' recursion detected\n");
1389 rc = -1;
1390 continue;
1391 } else {
1392 flag |= CMD_FLAG_BOOTD;
1395 #endif
1397 /* OK - call function to do the command */
1398 if ((cmdtp->cmd) (cmdtp, flag, argc, argv) != 0) {
1399 rc = -1;
1402 repeatable &= cmdtp->repeatable;
1404 /* Did the user stop this? */
1405 if (had_ctrlc ())
1406 return -1; /* if stopped then not repeatable */
1409 return rc ? rc : repeatable;
1412 /****************************************************************************/
1414 #if defined(CONFIG_CMD_RUN)
1415 int do_run (cmd_tbl_t * cmdtp, int flag, int argc, char *argv[])
1417 int i;
1419 if (argc < 2) {
1420 printf ("Usage:\n%s\n", cmdtp->usage);
1421 return 1;
1424 for (i=1; i<argc; ++i) {
1425 char *arg;
1427 if ((arg = getenv (argv[i])) == NULL) {
1428 printf ("## Error: \"%s\" not defined\n", argv[i]);
1429 return 1;
1431 #ifndef CFG_HUSH_PARSER
1432 if (run_command (arg, flag) == -1)
1433 return 1;
1434 #else
1435 if (parse_string_outer(arg,
1436 FLAG_PARSE_SEMICOLON | FLAG_EXIT_FROM_LOOP) != 0)
1437 return 1;
1438 #endif
1440 return 0;
1442 #endif