xref: /openbmc/u-boot/common/main.c (revision 6d0f6bcf)
1 /*
2  * (C) Copyright 2000
3  * Wolfgang Denk, DENX Software Engineering, wd@denx.de.
4  *
5  * Add to readline cmdline-editing by
6  * (C) Copyright 2005
7  * JinHua Luo, GuangDong Linux Center, <luo.jinhua@gd-linux.com>
8  *
9  * See file CREDITS for list of people who contributed to this
10  * project.
11  *
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.
16  *
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.
21  *
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
26  */
27 
28 /* #define	DEBUG	*/
29 
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
36 
37 #ifdef CONFIG_SYS_HUSH_PARSER
38 #include <hush.h>
39 #endif
40 
41 #include <post.h>
42 
43 #if defined(CONFIG_SILENT_CONSOLE) || defined(CONFIG_POST) || defined(CONFIG_CMDLINE_EDITING)
44 DECLARE_GLOBAL_DATA_PTR;
45 #endif
46 
47 /*
48  * Board-specific Platform code can reimplement show_boot_progress () if needed
49  */
50 void inline __show_boot_progress (int val) {}
51 void inline show_boot_progress (int val) __attribute__((weak, alias("__show_boot_progress")));
52 
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
56 
57 extern int do_bootd (cmd_tbl_t *cmdtp, int flag, int argc, char *argv[]);
58 
59 #if defined(CONFIG_UPDATE_TFTP)
60 void update_tftp (void);
61 #endif /* CONFIG_UPDATE_TFTP */
62 
63 #define MAX_DELAY_STOP_STR 32
64 
65 #if defined(CONFIG_BOOTDELAY) && (CONFIG_BOOTDELAY >= 0)
66 static int abortboot(int);
67 #endif
68 
69 #undef DEBUG_PARSER
70 
71 char        console_buffer[CONFIG_SYS_CBSIZE];		/* console I/O buffer	*/
72 
73 static char * delete_char (char *buffer, char *p, int *colp, int *np, int plen);
74 static char erase_seq[] = "\b \b";		/* erase sequence	*/
75 static char   tab_seq[] = "        ";		/* used to expand TABs	*/
76 
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
81 
82 #define	endtick(seconds) (get_ticks() + (uint64_t)(seconds) * get_tbclk())
83 
84 #ifndef CONFIG_BOOT_RETRY_MIN
85 #define CONFIG_BOOT_RETRY_MIN CONFIG_BOOT_RETRY_TIME
86 #endif
87 
88 #ifdef CONFIG_MODEM_SUPPORT
89 int do_mdm_init = 0;
90 extern void mdm_init(void); /* defined in board.c */
91 #endif
92 
93 /***************************************************************************
94  * Watch for 'delay' seconds for autoboot stop or autoboot delay string.
95  * returns: 0 -  no key string, allow autoboot
96  *          1 - got key string, abort
97  */
98 #if defined(CONFIG_BOOTDELAY) && (CONFIG_BOOTDELAY >= 0)
99 # if defined(CONFIG_AUTOBOOT_KEYED)
100 static __inline__ int abortboot(int bootdelay)
101 {
102 	int abort = 0;
103 	uint64_t etime = endtick(bootdelay);
104 	struct {
105 		char* str;
106 		u_int len;
107 		int retry;
108 	}
109 	delaykey [] = {
110 		{ str: getenv ("bootdelaykey"),  retry: 1 },
111 		{ str: getenv ("bootdelaykey2"), retry: 1 },
112 		{ str: getenv ("bootstopkey"),   retry: 0 },
113 		{ str: getenv ("bootstopkey2"),  retry: 0 },
114 	};
115 
116 	char presskey [MAX_DELAY_STOP_STR];
117 	u_int presskey_len = 0;
118 	u_int presskey_max = 0;
119 	u_int i;
120 
121 #  ifdef CONFIG_AUTOBOOT_PROMPT
122 	printf(CONFIG_AUTOBOOT_PROMPT);
123 #  endif
124 
125 #  ifdef CONFIG_AUTOBOOT_DELAY_STR
126 	if (delaykey[0].str == NULL)
127 		delaykey[0].str = CONFIG_AUTOBOOT_DELAY_STR;
128 #  endif
129 #  ifdef CONFIG_AUTOBOOT_DELAY_STR2
130 	if (delaykey[1].str == NULL)
131 		delaykey[1].str = CONFIG_AUTOBOOT_DELAY_STR2;
132 #  endif
133 #  ifdef CONFIG_AUTOBOOT_STOP_STR
134 	if (delaykey[2].str == NULL)
135 		delaykey[2].str = CONFIG_AUTOBOOT_STOP_STR;
136 #  endif
137 #  ifdef CONFIG_AUTOBOOT_STOP_STR2
138 	if (delaykey[3].str == NULL)
139 		delaykey[3].str = CONFIG_AUTOBOOT_STOP_STR2;
140 #  endif
141 
142 	for (i = 0; i < sizeof(delaykey) / sizeof(delaykey[0]); i ++) {
143 		delaykey[i].len = delaykey[i].str == NULL ?
144 				    0 : strlen (delaykey[i].str);
145 		delaykey[i].len = delaykey[i].len > MAX_DELAY_STOP_STR ?
146 				    MAX_DELAY_STOP_STR : delaykey[i].len;
147 
148 		presskey_max = presskey_max > delaykey[i].len ?
149 				    presskey_max : delaykey[i].len;
150 
151 #  if DEBUG_BOOTKEYS
152 		printf("%s key:<%s>\n",
153 		       delaykey[i].retry ? "delay" : "stop",
154 		       delaykey[i].str ? delaykey[i].str : "NULL");
155 #  endif
156 	}
157 
158 	/* In order to keep up with incoming data, check timeout only
159 	 * when catch up.
160 	 */
161 	while (!abort && get_ticks() <= etime) {
162 		for (i = 0; i < sizeof(delaykey) / sizeof(delaykey[0]); i ++) {
163 			if (delaykey[i].len > 0 &&
164 			    presskey_len >= delaykey[i].len &&
165 			    memcmp (presskey + presskey_len - delaykey[i].len,
166 				    delaykey[i].str,
167 				    delaykey[i].len) == 0) {
168 #  if DEBUG_BOOTKEYS
169 				printf("got %skey\n",
170 				       delaykey[i].retry ? "delay" : "stop");
171 #  endif
172 
173 #  ifdef CONFIG_BOOT_RETRY_TIME
174 				/* don't retry auto boot */
175 				if (! delaykey[i].retry)
176 					retry_time = -1;
177 #  endif
178 				abort = 1;
179 			}
180 		}
181 
182 		if (tstc()) {
183 			if (presskey_len < presskey_max) {
184 				presskey [presskey_len ++] = getc();
185 			}
186 			else {
187 				for (i = 0; i < presskey_max - 1; i ++)
188 					presskey [i] = presskey [i + 1];
189 
190 				presskey [i] = getc();
191 			}
192 		}
193 	}
194 #  if DEBUG_BOOTKEYS
195 	if (!abort)
196 		puts("key timeout\n");
197 #  endif
198 
199 #ifdef CONFIG_SILENT_CONSOLE
200 	if (abort)
201 		gd->flags &= ~GD_FLG_SILENT;
202 #endif
203 
204 	return abort;
205 }
206 
207 # else	/* !defined(CONFIG_AUTOBOOT_KEYED) */
208 
209 #ifdef CONFIG_MENUKEY
210 static int menukey = 0;
211 #endif
212 
213 static __inline__ int abortboot(int bootdelay)
214 {
215 	int abort = 0;
216 
217 #ifdef CONFIG_MENUPROMPT
218 	printf(CONFIG_MENUPROMPT);
219 #else
220 	printf("Hit any key to stop autoboot: %2d ", bootdelay);
221 #endif
222 
223 #if defined CONFIG_ZERO_BOOTDELAY_CHECK
224 	/*
225 	 * Check if key already pressed
226 	 * Don't check if bootdelay < 0
227 	 */
228 	if (bootdelay >= 0) {
229 		if (tstc()) {	/* we got a key press	*/
230 			(void) getc();  /* consume input	*/
231 			puts ("\b\b\b 0");
232 			abort = 1;	/* don't auto boot	*/
233 		}
234 	}
235 #endif
236 
237 	while ((bootdelay > 0) && (!abort)) {
238 		int i;
239 
240 		--bootdelay;
241 		/* delay 100 * 10ms */
242 		for (i=0; !abort && i<100; ++i) {
243 			if (tstc()) {	/* we got a key press	*/
244 				abort  = 1;	/* don't auto boot	*/
245 				bootdelay = 0;	/* no more delay	*/
246 # ifdef CONFIG_MENUKEY
247 				menukey = getc();
248 # else
249 				(void) getc();  /* consume input	*/
250 # endif
251 				break;
252 			}
253 			udelay(10000);
254 		}
255 
256 		printf("\b\b\b%2d ", bootdelay);
257 	}
258 
259 	putc('\n');
260 
261 #ifdef CONFIG_SILENT_CONSOLE
262 	if (abort)
263 		gd->flags &= ~GD_FLG_SILENT;
264 #endif
265 
266 	return abort;
267 }
268 # endif	/* CONFIG_AUTOBOOT_KEYED */
269 #endif	/* CONFIG_BOOTDELAY >= 0  */
270 
271 /****************************************************************************/
272 
273 void main_loop (void)
274 {
275 #ifndef CONFIG_SYS_HUSH_PARSER
276 	static char lastcommand[CONFIG_SYS_CBSIZE] = { 0, };
277 	int len;
278 	int rc = 1;
279 	int flag;
280 #endif
281 
282 #if defined(CONFIG_BOOTDELAY) && (CONFIG_BOOTDELAY >= 0)
283 	char *s;
284 	int bootdelay;
285 #endif
286 #ifdef CONFIG_PREBOOT
287 	char *p;
288 #endif
289 #ifdef CONFIG_BOOTCOUNT_LIMIT
290 	unsigned long bootcount = 0;
291 	unsigned long bootlimit = 0;
292 	char *bcs;
293 	char bcs_set[16];
294 #endif /* CONFIG_BOOTCOUNT_LIMIT */
295 
296 #if defined(CONFIG_VFD) && defined(VFD_TEST_LOGO)
297 	ulong bmp = 0;		/* default bitmap */
298 	extern int trab_vfd (ulong bitmap);
299 
300 #ifdef CONFIG_MODEM_SUPPORT
301 	if (do_mdm_init)
302 		bmp = 1;	/* alternate bitmap */
303 #endif
304 	trab_vfd (bmp);
305 #endif	/* CONFIG_VFD && VFD_TEST_LOGO */
306 
307 #if defined(CONFIG_UPDATE_TFTP)
308 	update_tftp ();
309 #endif /* CONFIG_UPDATE_TFTP */
310 
311 #ifdef CONFIG_BOOTCOUNT_LIMIT
312 	bootcount = bootcount_load();
313 	bootcount++;
314 	bootcount_store (bootcount);
315 	sprintf (bcs_set, "%lu", bootcount);
316 	setenv ("bootcount", bcs_set);
317 	bcs = getenv ("bootlimit");
318 	bootlimit = bcs ? simple_strtoul (bcs, NULL, 10) : 0;
319 #endif /* CONFIG_BOOTCOUNT_LIMIT */
320 
321 #ifdef CONFIG_MODEM_SUPPORT
322 	debug ("DEBUG: main_loop:   do_mdm_init=%d\n", do_mdm_init);
323 	if (do_mdm_init) {
324 		char *str = strdup(getenv("mdm_cmd"));
325 		setenv ("preboot", str);  /* set or delete definition */
326 		if (str != NULL)
327 			free (str);
328 		mdm_init(); /* wait for modem connection */
329 	}
330 #endif  /* CONFIG_MODEM_SUPPORT */
331 
332 #ifdef CONFIG_VERSION_VARIABLE
333 	{
334 		extern char version_string[];
335 
336 		setenv ("ver", version_string);  /* set version variable */
337 	}
338 #endif /* CONFIG_VERSION_VARIABLE */
339 
340 #ifdef CONFIG_SYS_HUSH_PARSER
341 	u_boot_hush_start ();
342 #endif
343 
344 #if defined(CONFIG_HUSH_INIT_VAR)
345 	hush_init_var ();
346 #endif
347 
348 #ifdef CONFIG_AUTO_COMPLETE
349 	install_auto_complete();
350 #endif
351 
352 #ifdef CONFIG_PREBOOT
353 	if ((p = getenv ("preboot")) != NULL) {
354 # ifdef CONFIG_AUTOBOOT_KEYED
355 		int prev = disable_ctrlc(1);	/* disable Control C checking */
356 # endif
357 
358 # ifndef CONFIG_SYS_HUSH_PARSER
359 		run_command (p, 0);
360 # else
361 		parse_string_outer(p, FLAG_PARSE_SEMICOLON |
362 				    FLAG_EXIT_FROM_LOOP);
363 # endif
364 
365 # ifdef CONFIG_AUTOBOOT_KEYED
366 		disable_ctrlc(prev);	/* restore Control C checking */
367 # endif
368 	}
369 #endif /* CONFIG_PREBOOT */
370 
371 #if defined(CONFIG_BOOTDELAY) && (CONFIG_BOOTDELAY >= 0)
372 	s = getenv ("bootdelay");
373 	bootdelay = s ? (int)simple_strtol(s, NULL, 10) : CONFIG_BOOTDELAY;
374 
375 	debug ("### main_loop entered: bootdelay=%d\n\n", bootdelay);
376 
377 # ifdef CONFIG_BOOT_RETRY_TIME
378 	init_cmd_timeout ();
379 # endif	/* CONFIG_BOOT_RETRY_TIME */
380 
381 #ifdef CONFIG_POST
382 	if (gd->flags & GD_FLG_POSTFAIL) {
383 		s = getenv("failbootcmd");
384 	}
385 	else
386 #endif /* CONFIG_POST */
387 #ifdef CONFIG_BOOTCOUNT_LIMIT
388 	if (bootlimit && (bootcount > bootlimit)) {
389 		printf ("Warning: Bootlimit (%u) exceeded. Using altbootcmd.\n",
390 		        (unsigned)bootlimit);
391 		s = getenv ("altbootcmd");
392 	}
393 	else
394 #endif /* CONFIG_BOOTCOUNT_LIMIT */
395 		s = getenv ("bootcmd");
396 
397 	debug ("### main_loop: bootcmd=\"%s\"\n", s ? s : "<UNDEFINED>");
398 
399 	if (bootdelay >= 0 && s && !abortboot (bootdelay)) {
400 # ifdef CONFIG_AUTOBOOT_KEYED
401 		int prev = disable_ctrlc(1);	/* disable Control C checking */
402 # endif
403 
404 # ifndef CONFIG_SYS_HUSH_PARSER
405 		run_command (s, 0);
406 # else
407 		parse_string_outer(s, FLAG_PARSE_SEMICOLON |
408 				    FLAG_EXIT_FROM_LOOP);
409 # endif
410 
411 # ifdef CONFIG_AUTOBOOT_KEYED
412 		disable_ctrlc(prev);	/* restore Control C checking */
413 # endif
414 	}
415 
416 # ifdef CONFIG_MENUKEY
417 	if (menukey == CONFIG_MENUKEY) {
418 	    s = getenv("menucmd");
419 	    if (s) {
420 # ifndef CONFIG_SYS_HUSH_PARSER
421 		run_command (s, 0);
422 # else
423 		parse_string_outer(s, FLAG_PARSE_SEMICOLON |
424 				    FLAG_EXIT_FROM_LOOP);
425 # endif
426 	    }
427 	}
428 #endif /* CONFIG_MENUKEY */
429 #endif	/* CONFIG_BOOTDELAY */
430 
431 #ifdef CONFIG_AMIGAONEG3SE
432 	{
433 	    extern void video_banner(void);
434 	    video_banner();
435 	}
436 #endif
437 
438 	/*
439 	 * Main Loop for Monitor Command Processing
440 	 */
441 #ifdef CONFIG_SYS_HUSH_PARSER
442 	parse_file_outer();
443 	/* This point is never reached */
444 	for (;;);
445 #else
446 	for (;;) {
447 #ifdef CONFIG_BOOT_RETRY_TIME
448 		if (rc >= 0) {
449 			/* Saw enough of a valid command to
450 			 * restart the timeout.
451 			 */
452 			reset_cmd_timeout();
453 		}
454 #endif
455 		len = readline (CONFIG_SYS_PROMPT);
456 
457 		flag = 0;	/* assume no special flags for now */
458 		if (len > 0)
459 			strcpy (lastcommand, console_buffer);
460 		else if (len == 0)
461 			flag |= CMD_FLAG_REPEAT;
462 #ifdef CONFIG_BOOT_RETRY_TIME
463 		else if (len == -2) {
464 			/* -2 means timed out, retry autoboot
465 			 */
466 			puts ("\nTimed out waiting for command\n");
467 # ifdef CONFIG_RESET_TO_RETRY
468 			/* Reinit board to run initialization code again */
469 			do_reset (NULL, 0, 0, NULL);
470 # else
471 			return;		/* retry autoboot */
472 # endif
473 		}
474 #endif
475 
476 		if (len == -1)
477 			puts ("<INTERRUPT>\n");
478 		else
479 			rc = run_command (lastcommand, flag);
480 
481 		if (rc <= 0) {
482 			/* invalid command or not repeatable, forget it */
483 			lastcommand[0] = 0;
484 		}
485 	}
486 #endif /*CONFIG_SYS_HUSH_PARSER*/
487 }
488 
489 #ifdef CONFIG_BOOT_RETRY_TIME
490 /***************************************************************************
491  * initialize command line timeout
492  */
493 void init_cmd_timeout(void)
494 {
495 	char *s = getenv ("bootretry");
496 
497 	if (s != NULL)
498 		retry_time = (int)simple_strtol(s, NULL, 10);
499 	else
500 		retry_time =  CONFIG_BOOT_RETRY_TIME;
501 
502 	if (retry_time >= 0 && retry_time < CONFIG_BOOT_RETRY_MIN)
503 		retry_time = CONFIG_BOOT_RETRY_MIN;
504 }
505 
506 /***************************************************************************
507  * reset command line timeout to retry_time seconds
508  */
509 void reset_cmd_timeout(void)
510 {
511 	endtime = endtick(retry_time);
512 }
513 #endif
514 
515 #ifdef CONFIG_CMDLINE_EDITING
516 
517 /*
518  * cmdline-editing related codes from vivi.
519  * Author: Janghoon Lyu <nandy@mizi.com>
520  */
521 
522 #define putnstr(str,n)	do {			\
523 		printf ("%.*s", (int)n, str);	\
524 	} while (0)
525 
526 #define CTL_CH(c)		((c) - 'a' + 1)
527 
528 #define MAX_CMDBUF_SIZE		256
529 
530 #define CTL_BACKSPACE		('\b')
531 #define DEL			((char)255)
532 #define DEL7			((char)127)
533 #define CREAD_HIST_CHAR		('!')
534 
535 #define getcmd_putch(ch)	putc(ch)
536 #define getcmd_getch()		getc()
537 #define getcmd_cbeep()		getcmd_putch('\a')
538 
539 #define HIST_MAX		20
540 #define HIST_SIZE		MAX_CMDBUF_SIZE
541 
542 static int hist_max = 0;
543 static int hist_add_idx = 0;
544 static int hist_cur = -1;
545 unsigned hist_num = 0;
546 
547 char* hist_list[HIST_MAX];
548 char hist_lines[HIST_MAX][HIST_SIZE];
549 
550 #define add_idx_minus_one() ((hist_add_idx == 0) ? hist_max : hist_add_idx-1)
551 
552 static void hist_init(void)
553 {
554 	int i;
555 
556 	hist_max = 0;
557 	hist_add_idx = 0;
558 	hist_cur = -1;
559 	hist_num = 0;
560 
561 	for (i = 0; i < HIST_MAX; i++) {
562 		hist_list[i] = hist_lines[i];
563 		hist_list[i][0] = '\0';
564 	}
565 }
566 
567 static void cread_add_to_hist(char *line)
568 {
569 	strcpy(hist_list[hist_add_idx], line);
570 
571 	if (++hist_add_idx >= HIST_MAX)
572 		hist_add_idx = 0;
573 
574 	if (hist_add_idx > hist_max)
575 		hist_max = hist_add_idx;
576 
577 	hist_num++;
578 }
579 
580 static char* hist_prev(void)
581 {
582 	char *ret;
583 	int old_cur;
584 
585 	if (hist_cur < 0)
586 		return NULL;
587 
588 	old_cur = hist_cur;
589 	if (--hist_cur < 0)
590 		hist_cur = hist_max;
591 
592 	if (hist_cur == hist_add_idx) {
593 		hist_cur = old_cur;
594 		ret = NULL;
595 	} else
596 		ret = hist_list[hist_cur];
597 
598 	return (ret);
599 }
600 
601 static char* hist_next(void)
602 {
603 	char *ret;
604 
605 	if (hist_cur < 0)
606 		return NULL;
607 
608 	if (hist_cur == hist_add_idx)
609 		return NULL;
610 
611 	if (++hist_cur > hist_max)
612 		hist_cur = 0;
613 
614 	if (hist_cur == hist_add_idx) {
615 		ret = "";
616 	} else
617 		ret = hist_list[hist_cur];
618 
619 	return (ret);
620 }
621 
622 #ifndef CONFIG_CMDLINE_EDITING
623 static void cread_print_hist_list(void)
624 {
625 	int i;
626 	unsigned long n;
627 
628 	n = hist_num - hist_max;
629 
630 	i = hist_add_idx + 1;
631 	while (1) {
632 		if (i > hist_max)
633 			i = 0;
634 		if (i == hist_add_idx)
635 			break;
636 		printf("%s\n", hist_list[i]);
637 		n++;
638 		i++;
639 	}
640 }
641 #endif /* CONFIG_CMDLINE_EDITING */
642 
643 #define BEGINNING_OF_LINE() {			\
644 	while (num) {				\
645 		getcmd_putch(CTL_BACKSPACE);	\
646 		num--;				\
647 	}					\
648 }
649 
650 #define ERASE_TO_EOL() {				\
651 	if (num < eol_num) {				\
652 		int tmp;				\
653 		for (tmp = num; tmp < eol_num; tmp++)	\
654 			getcmd_putch(' ');		\
655 		while (tmp-- > num)			\
656 			getcmd_putch(CTL_BACKSPACE);	\
657 		eol_num = num;				\
658 	}						\
659 }
660 
661 #define REFRESH_TO_EOL() {			\
662 	if (num < eol_num) {			\
663 		wlen = eol_num - num;		\
664 		putnstr(buf + num, wlen);	\
665 		num = eol_num;			\
666 	}					\
667 }
668 
669 static void cread_add_char(char ichar, int insert, unsigned long *num,
670 	       unsigned long *eol_num, char *buf, unsigned long len)
671 {
672 	unsigned long wlen;
673 
674 	/* room ??? */
675 	if (insert || *num == *eol_num) {
676 		if (*eol_num > len - 1) {
677 			getcmd_cbeep();
678 			return;
679 		}
680 		(*eol_num)++;
681 	}
682 
683 	if (insert) {
684 		wlen = *eol_num - *num;
685 		if (wlen > 1) {
686 			memmove(&buf[*num+1], &buf[*num], wlen-1);
687 		}
688 
689 		buf[*num] = ichar;
690 		putnstr(buf + *num, wlen);
691 		(*num)++;
692 		while (--wlen) {
693 			getcmd_putch(CTL_BACKSPACE);
694 		}
695 	} else {
696 		/* echo the character */
697 		wlen = 1;
698 		buf[*num] = ichar;
699 		putnstr(buf + *num, wlen);
700 		(*num)++;
701 	}
702 }
703 
704 static void cread_add_str(char *str, int strsize, int insert, unsigned long *num,
705 	      unsigned long *eol_num, char *buf, unsigned long len)
706 {
707 	while (strsize--) {
708 		cread_add_char(*str, insert, num, eol_num, buf, len);
709 		str++;
710 	}
711 }
712 
713 static int cread_line(const char *const prompt, char *buf, unsigned int *len)
714 {
715 	unsigned long num = 0;
716 	unsigned long eol_num = 0;
717 	unsigned long rlen;
718 	unsigned long wlen;
719 	char ichar;
720 	int insert = 1;
721 	int esc_len = 0;
722 	int rc = 0;
723 	char esc_save[8];
724 
725 	while (1) {
726 		rlen = 1;
727 #ifdef CONFIG_BOOT_RETRY_TIME
728 		while (!tstc()) {	/* while no incoming data */
729 			if (retry_time >= 0 && get_ticks() > endtime)
730 				return (-2);	/* timed out */
731 		}
732 #endif
733 
734 		ichar = getcmd_getch();
735 
736 		if ((ichar == '\n') || (ichar == '\r')) {
737 			putc('\n');
738 			break;
739 		}
740 
741 		/*
742 		 * handle standard linux xterm esc sequences for arrow key, etc.
743 		 */
744 		if (esc_len != 0) {
745 			if (esc_len == 1) {
746 				if (ichar == '[') {
747 					esc_save[esc_len] = ichar;
748 					esc_len = 2;
749 				} else {
750 					cread_add_str(esc_save, esc_len, insert,
751 						      &num, &eol_num, buf, *len);
752 					esc_len = 0;
753 				}
754 				continue;
755 			}
756 
757 			switch (ichar) {
758 
759 			case 'D':	/* <- key */
760 				ichar = CTL_CH('b');
761 				esc_len = 0;
762 				break;
763 			case 'C':	/* -> key */
764 				ichar = CTL_CH('f');
765 				esc_len = 0;
766 				break;	/* pass off to ^F handler */
767 			case 'H':	/* Home key */
768 				ichar = CTL_CH('a');
769 				esc_len = 0;
770 				break;	/* pass off to ^A handler */
771 			case 'A':	/* up arrow */
772 				ichar = CTL_CH('p');
773 				esc_len = 0;
774 				break;	/* pass off to ^P handler */
775 			case 'B':	/* down arrow */
776 				ichar = CTL_CH('n');
777 				esc_len = 0;
778 				break;	/* pass off to ^N handler */
779 			default:
780 				esc_save[esc_len++] = ichar;
781 				cread_add_str(esc_save, esc_len, insert,
782 					      &num, &eol_num, buf, *len);
783 				esc_len = 0;
784 				continue;
785 			}
786 		}
787 
788 		switch (ichar) {
789 		case 0x1b:
790 			if (esc_len == 0) {
791 				esc_save[esc_len] = ichar;
792 				esc_len = 1;
793 			} else {
794 				puts("impossible condition #876\n");
795 				esc_len = 0;
796 			}
797 			break;
798 
799 		case CTL_CH('a'):
800 			BEGINNING_OF_LINE();
801 			break;
802 		case CTL_CH('c'):	/* ^C - break */
803 			*buf = '\0';	/* discard input */
804 			return (-1);
805 		case CTL_CH('f'):
806 			if (num < eol_num) {
807 				getcmd_putch(buf[num]);
808 				num++;
809 			}
810 			break;
811 		case CTL_CH('b'):
812 			if (num) {
813 				getcmd_putch(CTL_BACKSPACE);
814 				num--;
815 			}
816 			break;
817 		case CTL_CH('d'):
818 			if (num < eol_num) {
819 				wlen = eol_num - num - 1;
820 				if (wlen) {
821 					memmove(&buf[num], &buf[num+1], wlen);
822 					putnstr(buf + num, wlen);
823 				}
824 
825 				getcmd_putch(' ');
826 				do {
827 					getcmd_putch(CTL_BACKSPACE);
828 				} while (wlen--);
829 				eol_num--;
830 			}
831 			break;
832 		case CTL_CH('k'):
833 			ERASE_TO_EOL();
834 			break;
835 		case CTL_CH('e'):
836 			REFRESH_TO_EOL();
837 			break;
838 		case CTL_CH('o'):
839 			insert = !insert;
840 			break;
841 		case CTL_CH('x'):
842 		case CTL_CH('u'):
843 			BEGINNING_OF_LINE();
844 			ERASE_TO_EOL();
845 			break;
846 		case DEL:
847 		case DEL7:
848 		case 8:
849 			if (num) {
850 				wlen = eol_num - num;
851 				num--;
852 				memmove(&buf[num], &buf[num+1], wlen);
853 				getcmd_putch(CTL_BACKSPACE);
854 				putnstr(buf + num, wlen);
855 				getcmd_putch(' ');
856 				do {
857 					getcmd_putch(CTL_BACKSPACE);
858 				} while (wlen--);
859 				eol_num--;
860 			}
861 			break;
862 		case CTL_CH('p'):
863 		case CTL_CH('n'):
864 		{
865 			char * hline;
866 
867 			esc_len = 0;
868 
869 			if (ichar == CTL_CH('p'))
870 				hline = hist_prev();
871 			else
872 				hline = hist_next();
873 
874 			if (!hline) {
875 				getcmd_cbeep();
876 				continue;
877 			}
878 
879 			/* nuke the current line */
880 			/* first, go home */
881 			BEGINNING_OF_LINE();
882 
883 			/* erase to end of line */
884 			ERASE_TO_EOL();
885 
886 			/* copy new line into place and display */
887 			strcpy(buf, hline);
888 			eol_num = strlen(buf);
889 			REFRESH_TO_EOL();
890 			continue;
891 		}
892 #ifdef CONFIG_AUTO_COMPLETE
893 		case '\t': {
894 			int num2, col;
895 
896 			/* do not autocomplete when in the middle */
897 			if (num < eol_num) {
898 				getcmd_cbeep();
899 				break;
900 			}
901 
902 			buf[num] = '\0';
903 			col = strlen(prompt) + eol_num;
904 			num2 = num;
905 			if (cmd_auto_complete(prompt, buf, &num2, &col)) {
906 				col = num2 - num;
907 				num += col;
908 				eol_num += col;
909 			}
910 			break;
911 		}
912 #endif
913 		default:
914 			cread_add_char(ichar, insert, &num, &eol_num, buf, *len);
915 			break;
916 		}
917 	}
918 	*len = eol_num;
919 	buf[eol_num] = '\0';	/* lose the newline */
920 
921 	if (buf[0] && buf[0] != CREAD_HIST_CHAR)
922 		cread_add_to_hist(buf);
923 	hist_cur = hist_add_idx;
924 
925 	return (rc);
926 }
927 
928 #endif /* CONFIG_CMDLINE_EDITING */
929 
930 /****************************************************************************/
931 
932 /*
933  * Prompt for input and read a line.
934  * If  CONFIG_BOOT_RETRY_TIME is defined and retry_time >= 0,
935  * time out when time goes past endtime (timebase time in ticks).
936  * Return:	number of read characters
937  *		-1 if break
938  *		-2 if timed out
939  */
940 int readline (const char *const prompt)
941 {
942 	return readline_into_buffer(prompt, console_buffer);
943 }
944 
945 
946 int readline_into_buffer (const char *const prompt, char * buffer)
947 {
948 	char *p = buffer;
949 #ifdef CONFIG_CMDLINE_EDITING
950 	unsigned int len=MAX_CMDBUF_SIZE;
951 	int rc;
952 	static int initted = 0;
953 
954 	/*
955 	 * History uses a global array which is not
956 	 * writable until after relocation to RAM.
957 	 * Revert to non-history version if still
958 	 * running from flash.
959 	 */
960 	if (gd->flags & GD_FLG_RELOC) {
961 		if (!initted) {
962 			hist_init();
963 			initted = 1;
964 		}
965 
966 		puts (prompt);
967 
968 		rc = cread_line(prompt, p, &len);
969 		return rc < 0 ? rc : len;
970 
971 	} else {
972 #endif	/* CONFIG_CMDLINE_EDITING */
973 	char * p_buf = p;
974 	int	n = 0;				/* buffer index		*/
975 	int	plen = 0;			/* prompt length	*/
976 	int	col;				/* output column cnt	*/
977 	char	c;
978 
979 	/* print prompt */
980 	if (prompt) {
981 		plen = strlen (prompt);
982 		puts (prompt);
983 	}
984 	col = plen;
985 
986 	for (;;) {
987 #ifdef CONFIG_BOOT_RETRY_TIME
988 		while (!tstc()) {	/* while no incoming data */
989 			if (retry_time >= 0 && get_ticks() > endtime)
990 				return (-2);	/* timed out */
991 		}
992 #endif
993 		WATCHDOG_RESET();		/* Trigger watchdog, if needed */
994 
995 #ifdef CONFIG_SHOW_ACTIVITY
996 		while (!tstc()) {
997 			extern void show_activity(int arg);
998 			show_activity(0);
999 		}
1000 #endif
1001 		c = getc();
1002 
1003 		/*
1004 		 * Special character handling
1005 		 */
1006 		switch (c) {
1007 		case '\r':				/* Enter		*/
1008 		case '\n':
1009 			*p = '\0';
1010 			puts ("\r\n");
1011 			return (p - p_buf);
1012 
1013 		case '\0':				/* nul			*/
1014 			continue;
1015 
1016 		case 0x03:				/* ^C - break		*/
1017 			p_buf[0] = '\0';	/* discard input */
1018 			return (-1);
1019 
1020 		case 0x15:				/* ^U - erase line	*/
1021 			while (col > plen) {
1022 				puts (erase_seq);
1023 				--col;
1024 			}
1025 			p = p_buf;
1026 			n = 0;
1027 			continue;
1028 
1029 		case 0x17:				/* ^W - erase word	*/
1030 			p=delete_char(p_buf, p, &col, &n, plen);
1031 			while ((n > 0) && (*p != ' ')) {
1032 				p=delete_char(p_buf, p, &col, &n, plen);
1033 			}
1034 			continue;
1035 
1036 		case 0x08:				/* ^H  - backspace	*/
1037 		case 0x7F:				/* DEL - backspace	*/
1038 			p=delete_char(p_buf, p, &col, &n, plen);
1039 			continue;
1040 
1041 		default:
1042 			/*
1043 			 * Must be a normal character then
1044 			 */
1045 			if (n < CONFIG_SYS_CBSIZE-2) {
1046 				if (c == '\t') {	/* expand TABs		*/
1047 #ifdef CONFIG_AUTO_COMPLETE
1048 					/* if auto completion triggered just continue */
1049 					*p = '\0';
1050 					if (cmd_auto_complete(prompt, console_buffer, &n, &col)) {
1051 						p = p_buf + n;	/* reset */
1052 						continue;
1053 					}
1054 #endif
1055 					puts (tab_seq+(col&07));
1056 					col += 8 - (col&07);
1057 				} else {
1058 					++col;		/* echo input		*/
1059 					putc (c);
1060 				}
1061 				*p++ = c;
1062 				++n;
1063 			} else {			/* Buffer full		*/
1064 				putc ('\a');
1065 			}
1066 		}
1067 	}
1068 #ifdef CONFIG_CMDLINE_EDITING
1069 	}
1070 #endif
1071 }
1072 
1073 /****************************************************************************/
1074 
1075 static char * delete_char (char *buffer, char *p, int *colp, int *np, int plen)
1076 {
1077 	char *s;
1078 
1079 	if (*np == 0) {
1080 		return (p);
1081 	}
1082 
1083 	if (*(--p) == '\t') {			/* will retype the whole line	*/
1084 		while (*colp > plen) {
1085 			puts (erase_seq);
1086 			(*colp)--;
1087 		}
1088 		for (s=buffer; s<p; ++s) {
1089 			if (*s == '\t') {
1090 				puts (tab_seq+((*colp) & 07));
1091 				*colp += 8 - ((*colp) & 07);
1092 			} else {
1093 				++(*colp);
1094 				putc (*s);
1095 			}
1096 		}
1097 	} else {
1098 		puts (erase_seq);
1099 		(*colp)--;
1100 	}
1101 	(*np)--;
1102 	return (p);
1103 }
1104 
1105 /****************************************************************************/
1106 
1107 int parse_line (char *line, char *argv[])
1108 {
1109 	int nargs = 0;
1110 
1111 #ifdef DEBUG_PARSER
1112 	printf ("parse_line: \"%s\"\n", line);
1113 #endif
1114 	while (nargs < CONFIG_SYS_MAXARGS) {
1115 
1116 		/* skip any white space */
1117 		while ((*line == ' ') || (*line == '\t')) {
1118 			++line;
1119 		}
1120 
1121 		if (*line == '\0') {	/* end of line, no more args	*/
1122 			argv[nargs] = NULL;
1123 #ifdef DEBUG_PARSER
1124 		printf ("parse_line: nargs=%d\n", nargs);
1125 #endif
1126 			return (nargs);
1127 		}
1128 
1129 		argv[nargs++] = line;	/* begin of argument string	*/
1130 
1131 		/* find end of string */
1132 		while (*line && (*line != ' ') && (*line != '\t')) {
1133 			++line;
1134 		}
1135 
1136 		if (*line == '\0') {	/* end of line, no more args	*/
1137 			argv[nargs] = NULL;
1138 #ifdef DEBUG_PARSER
1139 		printf ("parse_line: nargs=%d\n", nargs);
1140 #endif
1141 			return (nargs);
1142 		}
1143 
1144 		*line++ = '\0';		/* terminate current arg	 */
1145 	}
1146 
1147 	printf ("** Too many args (max. %d) **\n", CONFIG_SYS_MAXARGS);
1148 
1149 #ifdef DEBUG_PARSER
1150 	printf ("parse_line: nargs=%d\n", nargs);
1151 #endif
1152 	return (nargs);
1153 }
1154 
1155 /****************************************************************************/
1156 
1157 static void process_macros (const char *input, char *output)
1158 {
1159 	char c, prev;
1160 	const char *varname_start = NULL;
1161 	int inputcnt = strlen (input);
1162 	int outputcnt = CONFIG_SYS_CBSIZE;
1163 	int state = 0;		/* 0 = waiting for '$'  */
1164 
1165 	/* 1 = waiting for '(' or '{' */
1166 	/* 2 = waiting for ')' or '}' */
1167 	/* 3 = waiting for '''  */
1168 #ifdef DEBUG_PARSER
1169 	char *output_start = output;
1170 
1171 	printf ("[PROCESS_MACROS] INPUT len %d: \"%s\"\n", strlen (input),
1172 		input);
1173 #endif
1174 
1175 	prev = '\0';		/* previous character   */
1176 
1177 	while (inputcnt && outputcnt) {
1178 		c = *input++;
1179 		inputcnt--;
1180 
1181 		if (state != 3) {
1182 			/* remove one level of escape characters */
1183 			if ((c == '\\') && (prev != '\\')) {
1184 				if (inputcnt-- == 0)
1185 					break;
1186 				prev = c;
1187 				c = *input++;
1188 			}
1189 		}
1190 
1191 		switch (state) {
1192 		case 0:	/* Waiting for (unescaped) $    */
1193 			if ((c == '\'') && (prev != '\\')) {
1194 				state = 3;
1195 				break;
1196 			}
1197 			if ((c == '$') && (prev != '\\')) {
1198 				state++;
1199 			} else {
1200 				*(output++) = c;
1201 				outputcnt--;
1202 			}
1203 			break;
1204 		case 1:	/* Waiting for (        */
1205 			if (c == '(' || c == '{') {
1206 				state++;
1207 				varname_start = input;
1208 			} else {
1209 				state = 0;
1210 				*(output++) = '$';
1211 				outputcnt--;
1212 
1213 				if (outputcnt) {
1214 					*(output++) = c;
1215 					outputcnt--;
1216 				}
1217 			}
1218 			break;
1219 		case 2:	/* Waiting for )        */
1220 			if (c == ')' || c == '}') {
1221 				int i;
1222 				char envname[CONFIG_SYS_CBSIZE], *envval;
1223 				int envcnt = input - varname_start - 1;	/* Varname # of chars */
1224 
1225 				/* Get the varname */
1226 				for (i = 0; i < envcnt; i++) {
1227 					envname[i] = varname_start[i];
1228 				}
1229 				envname[i] = 0;
1230 
1231 				/* Get its value */
1232 				envval = getenv (envname);
1233 
1234 				/* Copy into the line if it exists */
1235 				if (envval != NULL)
1236 					while ((*envval) && outputcnt) {
1237 						*(output++) = *(envval++);
1238 						outputcnt--;
1239 					}
1240 				/* Look for another '$' */
1241 				state = 0;
1242 			}
1243 			break;
1244 		case 3:	/* Waiting for '        */
1245 			if ((c == '\'') && (prev != '\\')) {
1246 				state = 0;
1247 			} else {
1248 				*(output++) = c;
1249 				outputcnt--;
1250 			}
1251 			break;
1252 		}
1253 		prev = c;
1254 	}
1255 
1256 	if (outputcnt)
1257 		*output = 0;
1258 	else
1259 		*(output - 1) = 0;
1260 
1261 #ifdef DEBUG_PARSER
1262 	printf ("[PROCESS_MACROS] OUTPUT len %d: \"%s\"\n",
1263 		strlen (output_start), output_start);
1264 #endif
1265 }
1266 
1267 /****************************************************************************
1268  * returns:
1269  *	1  - command executed, repeatable
1270  *	0  - command executed but not repeatable, interrupted commands are
1271  *	     always considered not repeatable
1272  *	-1 - not executed (unrecognized, bootd recursion or too many args)
1273  *           (If cmd is NULL or "" or longer than CONFIG_SYS_CBSIZE-1 it is
1274  *           considered unrecognized)
1275  *
1276  * WARNING:
1277  *
1278  * We must create a temporary copy of the command since the command we get
1279  * may be the result from getenv(), which returns a pointer directly to
1280  * the environment data, which may change magicly when the command we run
1281  * creates or modifies environment variables (like "bootp" does).
1282  */
1283 
1284 int run_command (const char *cmd, int flag)
1285 {
1286 	cmd_tbl_t *cmdtp;
1287 	char cmdbuf[CONFIG_SYS_CBSIZE];	/* working copy of cmd		*/
1288 	char *token;			/* start of token in cmdbuf	*/
1289 	char *sep;			/* end of token (separator) in cmdbuf */
1290 	char finaltoken[CONFIG_SYS_CBSIZE];
1291 	char *str = cmdbuf;
1292 	char *argv[CONFIG_SYS_MAXARGS + 1];	/* NULL terminated	*/
1293 	int argc, inquotes;
1294 	int repeatable = 1;
1295 	int rc = 0;
1296 
1297 #ifdef DEBUG_PARSER
1298 	printf ("[RUN_COMMAND] cmd[%p]=\"", cmd);
1299 	puts (cmd ? cmd : "NULL");	/* use puts - string may be loooong */
1300 	puts ("\"\n");
1301 #endif
1302 
1303 	clear_ctrlc();		/* forget any previous Control C */
1304 
1305 	if (!cmd || !*cmd) {
1306 		return -1;	/* empty command */
1307 	}
1308 
1309 	if (strlen(cmd) >= CONFIG_SYS_CBSIZE) {
1310 		puts ("## Command too long!\n");
1311 		return -1;
1312 	}
1313 
1314 	strcpy (cmdbuf, cmd);
1315 
1316 	/* Process separators and check for invalid
1317 	 * repeatable commands
1318 	 */
1319 
1320 #ifdef DEBUG_PARSER
1321 	printf ("[PROCESS_SEPARATORS] %s\n", cmd);
1322 #endif
1323 	while (*str) {
1324 
1325 		/*
1326 		 * Find separator, or string end
1327 		 * Allow simple escape of ';' by writing "\;"
1328 		 */
1329 		for (inquotes = 0, sep = str; *sep; sep++) {
1330 			if ((*sep=='\'') &&
1331 			    (*(sep-1) != '\\'))
1332 				inquotes=!inquotes;
1333 
1334 			if (!inquotes &&
1335 			    (*sep == ';') &&	/* separator		*/
1336 			    ( sep != str) &&	/* past string start	*/
1337 			    (*(sep-1) != '\\'))	/* and NOT escaped	*/
1338 				break;
1339 		}
1340 
1341 		/*
1342 		 * Limit the token to data between separators
1343 		 */
1344 		token = str;
1345 		if (*sep) {
1346 			str = sep + 1;	/* start of command for next pass */
1347 			*sep = '\0';
1348 		}
1349 		else
1350 			str = sep;	/* no more commands for next pass */
1351 #ifdef DEBUG_PARSER
1352 		printf ("token: \"%s\"\n", token);
1353 #endif
1354 
1355 		/* find macros in this token and replace them */
1356 		process_macros (token, finaltoken);
1357 
1358 		/* Extract arguments */
1359 		if ((argc = parse_line (finaltoken, argv)) == 0) {
1360 			rc = -1;	/* no command at all */
1361 			continue;
1362 		}
1363 
1364 		/* Look up command in command table */
1365 		if ((cmdtp = find_cmd(argv[0])) == NULL) {
1366 			printf ("Unknown command '%s' - try 'help'\n", argv[0]);
1367 			rc = -1;	/* give up after bad command */
1368 			continue;
1369 		}
1370 
1371 		/* found - check max args */
1372 		if (argc > cmdtp->maxargs) {
1373 			printf ("Usage:\n%s\n", cmdtp->usage);
1374 			rc = -1;
1375 			continue;
1376 		}
1377 
1378 #if defined(CONFIG_CMD_BOOTD)
1379 		/* avoid "bootd" recursion */
1380 		if (cmdtp->cmd == do_bootd) {
1381 #ifdef DEBUG_PARSER
1382 			printf ("[%s]\n", finaltoken);
1383 #endif
1384 			if (flag & CMD_FLAG_BOOTD) {
1385 				puts ("'bootd' recursion detected\n");
1386 				rc = -1;
1387 				continue;
1388 			} else {
1389 				flag |= CMD_FLAG_BOOTD;
1390 			}
1391 		}
1392 #endif
1393 
1394 		/* OK - call function to do the command */
1395 		if ((cmdtp->cmd) (cmdtp, flag, argc, argv) != 0) {
1396 			rc = -1;
1397 		}
1398 
1399 		repeatable &= cmdtp->repeatable;
1400 
1401 		/* Did the user stop this? */
1402 		if (had_ctrlc ())
1403 			return -1;	/* if stopped then not repeatable */
1404 	}
1405 
1406 	return rc ? rc : repeatable;
1407 }
1408 
1409 /****************************************************************************/
1410 
1411 #if defined(CONFIG_CMD_RUN)
1412 int do_run (cmd_tbl_t * cmdtp, int flag, int argc, char *argv[])
1413 {
1414 	int i;
1415 
1416 	if (argc < 2) {
1417 		printf ("Usage:\n%s\n", cmdtp->usage);
1418 		return 1;
1419 	}
1420 
1421 	for (i=1; i<argc; ++i) {
1422 		char *arg;
1423 
1424 		if ((arg = getenv (argv[i])) == NULL) {
1425 			printf ("## Error: \"%s\" not defined\n", argv[i]);
1426 			return 1;
1427 		}
1428 #ifndef CONFIG_SYS_HUSH_PARSER
1429 		if (run_command (arg, flag) == -1)
1430 			return 1;
1431 #else
1432 		if (parse_string_outer(arg,
1433 		    FLAG_PARSE_SEMICOLON | FLAG_EXIT_FROM_LOOP) != 0)
1434 			return 1;
1435 #endif
1436 	}
1437 	return 0;
1438 }
1439 #endif
1440