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