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