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