xref: /rk3399_rockchip-uboot/common/main.c (revision dd875c767e6fb0f4fecfb799b706d84562a7acee)
1 /*
2  * (C) Copyright 2000
3  * Wolfgang Denk, DENX Software Engineering, wd@denx.de.
4  *
5  * See file CREDITS for list of people who contributed to this
6  * project.
7  *
8  * This program is free software; you can redistribute it and/or
9  * modify it under the terms of the GNU General Public License as
10  * published by the Free Software Foundation; either version 2 of
11  * the License, or (at your option) any later version.
12  *
13  * This program is distributed in the hope that it will be useful,
14  * but WITHOUT ANY WARRANTY; without even the implied warranty of
15  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
16  * GNU General Public License for more details.
17  *
18  * You should have received a copy of the GNU General Public License
19  * along with this program; if not, write to the Free Software
20  * Foundation, Inc., 59 Temple Place, Suite 330, Boston,
21  * MA 02111-1307 USA
22  */
23 
24 /* #define	DEBUG	*/
25 
26 #include <common.h>
27 #include <watchdog.h>
28 #include <command.h>
29 #include <malloc.h>
30 
31 #ifdef CFG_HUSH_PARSER
32 #include <hush.h>
33 #endif
34 
35 #include <post.h>
36 
37 #if defined(CONFIG_BOOT_RETRY_TIME) && defined(CONFIG_RESET_TO_RETRY)
38 extern int do_reset (cmd_tbl_t *cmdtp, int flag, int argc, char *argv[]);		/* for do_reset() prototype */
39 #endif
40 
41 extern int do_bootd (cmd_tbl_t *cmdtp, int flag, int argc, char *argv[]);
42 
43 
44 #define MAX_DELAY_STOP_STR 32
45 
46 static char * delete_char (char *buffer, char *p, int *colp, int *np, int plen);
47 static int parse_line (char *, char *[]);
48 #if defined(CONFIG_BOOTDELAY) && (CONFIG_BOOTDELAY >= 0)
49 static int abortboot(int);
50 #endif
51 
52 #undef DEBUG_PARSER
53 
54 char        console_buffer[CFG_CBSIZE];		/* console I/O buffer	*/
55 
56 static char erase_seq[] = "\b \b";		/* erase sequence	*/
57 static char   tab_seq[] = "        ";		/* used to expand TABs	*/
58 
59 #ifdef CONFIG_BOOT_RETRY_TIME
60 static uint64_t endtime = 0;  /* must be set, default is instant timeout */
61 static int      retry_time = -1; /* -1 so can call readline before main_loop */
62 #endif
63 
64 #define	endtick(seconds) (get_ticks() + (uint64_t)(seconds) * get_tbclk())
65 
66 #ifndef CONFIG_BOOT_RETRY_MIN
67 #define CONFIG_BOOT_RETRY_MIN CONFIG_BOOT_RETRY_TIME
68 #endif
69 
70 #ifdef CONFIG_MODEM_SUPPORT
71 int do_mdm_init = 0;
72 extern void mdm_init(void); /* defined in board.c */
73 #endif
74 
75 /***************************************************************************
76  * Watch for 'delay' seconds for autoboot stop or autoboot delay string.
77  * returns: 0 -  no key string, allow autoboot
78  *          1 - got key string, abort
79  */
80 #if defined(CONFIG_BOOTDELAY) && (CONFIG_BOOTDELAY >= 0)
81 # if defined(CONFIG_AUTOBOOT_KEYED)
82 static __inline__ int abortboot(int bootdelay)
83 {
84 	int abort = 0;
85 	uint64_t etime = endtick(bootdelay);
86 	struct
87 	{
88 		char* str;
89 		u_int len;
90 		int retry;
91 	}
92 	delaykey [] =
93 	{
94 		{ str: getenv ("bootdelaykey"),  retry: 1 },
95 		{ str: getenv ("bootdelaykey2"), retry: 1 },
96 		{ str: getenv ("bootstopkey"),   retry: 0 },
97 		{ str: getenv ("bootstopkey2"),  retry: 0 },
98 	};
99 
100 	char presskey [MAX_DELAY_STOP_STR];
101 	u_int presskey_len = 0;
102 	u_int presskey_max = 0;
103 	u_int i;
104 
105 #ifdef CONFIG_SILENT_CONSOLE
106 	{
107 		DECLARE_GLOBAL_DATA_PTR;
108 
109 		if (gd->flags & GD_FLG_SILENT) {
110 			/* Restore serial console */
111 			console_assign (stdout, "serial");
112 			console_assign (stderr, "serial");
113 		}
114 	}
115 #endif
116 
117 #  ifdef CONFIG_AUTOBOOT_PROMPT
118 	printf (CONFIG_AUTOBOOT_PROMPT, bootdelay);
119 #  endif
120 
121 #  ifdef CONFIG_AUTOBOOT_DELAY_STR
122 	if (delaykey[0].str == NULL)
123 		delaykey[0].str = CONFIG_AUTOBOOT_DELAY_STR;
124 #  endif
125 #  ifdef CONFIG_AUTOBOOT_DELAY_STR2
126 	if (delaykey[1].str == NULL)
127 		delaykey[1].str = CONFIG_AUTOBOOT_DELAY_STR2;
128 #  endif
129 #  ifdef CONFIG_AUTOBOOT_STOP_STR
130 	if (delaykey[2].str == NULL)
131 		delaykey[2].str = CONFIG_AUTOBOOT_STOP_STR;
132 #  endif
133 #  ifdef CONFIG_AUTOBOOT_STOP_STR2
134 	if (delaykey[3].str == NULL)
135 		delaykey[3].str = CONFIG_AUTOBOOT_STOP_STR2;
136 #  endif
137 
138 	for (i = 0; i < sizeof(delaykey) / sizeof(delaykey[0]); i ++) {
139 		delaykey[i].len = delaykey[i].str == NULL ?
140 				    0 : strlen (delaykey[i].str);
141 		delaykey[i].len = delaykey[i].len > MAX_DELAY_STOP_STR ?
142 				    MAX_DELAY_STOP_STR : delaykey[i].len;
143 
144 		presskey_max = presskey_max > delaykey[i].len ?
145 				    presskey_max : delaykey[i].len;
146 
147 #  if DEBUG_BOOTKEYS
148 		printf("%s key:<%s>\n",
149 		       delaykey[i].retry ? "delay" : "stop",
150 		       delaykey[i].str ? delaykey[i].str : "NULL");
151 #  endif
152 	}
153 
154 	/* In order to keep up with incoming data, check timeout only
155 	 * when catch up.
156 	 */
157 	while (!abort && get_ticks() <= etime) {
158 		for (i = 0; i < sizeof(delaykey) / sizeof(delaykey[0]); i ++) {
159 			if (delaykey[i].len > 0 &&
160 			    presskey_len >= delaykey[i].len &&
161 			    memcmp (presskey + presskey_len - delaykey[i].len,
162 				    delaykey[i].str,
163 				    delaykey[i].len) == 0) {
164 #  if DEBUG_BOOTKEYS
165 				printf("got %skey\n",
166 				       delaykey[i].retry ? "delay" : "stop");
167 #  endif
168 
169 #  ifdef CONFIG_BOOT_RETRY_TIME
170 				/* don't retry auto boot */
171 				if (! delaykey[i].retry)
172 					retry_time = -1;
173 #  endif
174 				abort = 1;
175 			}
176 		}
177 
178 		if (tstc()) {
179 			if (presskey_len < presskey_max) {
180 				presskey [presskey_len ++] = getc();
181 			}
182 			else {
183 				for (i = 0; i < presskey_max - 1; i ++)
184 					presskey [i] = presskey [i + 1];
185 
186 				presskey [i] = getc();
187 			}
188 		}
189 	}
190 #  if DEBUG_BOOTKEYS
191 	if (!abort)
192 		printf("key timeout\n");
193 #  endif
194 
195 #ifdef CONFIG_SILENT_CONSOLE
196 	{
197 		DECLARE_GLOBAL_DATA_PTR;
198 
199 		if (abort) {
200 			/* permanently enable normal console output */
201 			gd->flags &= ~(GD_FLG_SILENT);
202 		} else if (gd->flags & GD_FLG_SILENT) {
203 			/* Restore silent console */
204 			console_assign (stdout, "nulldev");
205 			console_assign (stderr, "nulldev");
206 		}
207 	}
208 #endif
209 
210 	return abort;
211 }
212 
213 # else	/* !defined(CONFIG_AUTOBOOT_KEYED) */
214 
215 #ifdef CONFIG_MENUKEY
216 static int menukey = 0;
217 #endif
218 
219 static __inline__ int abortboot(int bootdelay)
220 {
221 	int abort = 0;
222 
223 #ifdef CONFIG_SILENT_CONSOLE
224 	{
225 		DECLARE_GLOBAL_DATA_PTR;
226 
227 		if (gd->flags & GD_FLG_SILENT) {
228 			/* Restore serial console */
229 			console_assign (stdout, "serial");
230 			console_assign (stderr, "serial");
231 		}
232 	}
233 #endif
234 
235 #ifdef CONFIG_MENUPROMPT
236 	printf(CONFIG_MENUPROMPT, bootdelay);
237 #else
238 	printf("Hit any key to stop autoboot: %2d ", bootdelay);
239 #endif
240 
241 #if defined CONFIG_ZERO_BOOTDELAY_CHECK
242 	/*
243 	 * Check if key already pressed
244 	 * Don't check if bootdelay < 0
245 	 */
246 	if (bootdelay >= 0) {
247 		if (tstc()) {	/* we got a key press	*/
248 			(void) getc();  /* consume input	*/
249 			printf ("\b\b\b 0");
250 			abort = 1; 	/* don't auto boot	*/
251 		}
252 	}
253 #endif
254 
255 	while ((bootdelay > 0) && (!abort)) {
256 		int i;
257 
258 		--bootdelay;
259 		/* delay 100 * 10ms */
260 		for (i=0; !abort && i<100; ++i) {
261 			if (tstc()) {	/* we got a key press	*/
262 				abort  = 1;	/* don't auto boot	*/
263 				bootdelay = 0;	/* no more delay	*/
264 # ifdef CONFIG_MENUKEY
265 				menukey = getc();
266 # else
267 				(void) getc();  /* consume input	*/
268 # endif
269 				break;
270 			}
271 			udelay (10000);
272 		}
273 
274 		printf ("\b\b\b%2d ", bootdelay);
275 	}
276 
277 	putc ('\n');
278 
279 #ifdef CONFIG_SILENT_CONSOLE
280 	{
281 		DECLARE_GLOBAL_DATA_PTR;
282 
283 		if (abort) {
284 			/* permanently enable normal console output */
285 			gd->flags &= ~(GD_FLG_SILENT);
286 		} else if (gd->flags & GD_FLG_SILENT) {
287 			/* Restore silent console */
288 			console_assign (stdout, "nulldev");
289 			console_assign (stderr, "nulldev");
290 		}
291 	}
292 #endif
293 
294 	return abort;
295 }
296 # endif	/* CONFIG_AUTOBOOT_KEYED */
297 #endif	/* CONFIG_BOOTDELAY >= 0  */
298 
299 /****************************************************************************/
300 
301 void main_loop (void)
302 {
303 #ifndef CFG_HUSH_PARSER
304 	static char lastcommand[CFG_CBSIZE] = { 0, };
305 	int len;
306 	int rc = 1;
307 	int flag;
308 #endif
309 
310 #if defined(CONFIG_BOOTDELAY) && (CONFIG_BOOTDELAY >= 0)
311 	char *s;
312 	int bootdelay;
313 #endif
314 #ifdef CONFIG_PREBOOT
315 	char *p;
316 #endif
317 #ifdef CONFIG_BOOTCOUNT_LIMIT
318 	unsigned long bootcount = 0;
319 	unsigned long bootlimit = 0;
320 	char *bcs;
321 	char bcs_set[16];
322 #endif /* CONFIG_BOOTCOUNT_LIMIT */
323 
324 #if defined(CONFIG_VFD) && defined(VFD_TEST_LOGO)
325 	ulong bmp = 0;		/* default bitmap */
326 	extern int trab_vfd (ulong bitmap);
327 
328 #ifdef CONFIG_MODEM_SUPPORT
329 	if (do_mdm_init)
330 		bmp = 1;	/* alternate bitmap */
331 #endif
332 	trab_vfd (bmp);
333 #endif	/* CONFIG_VFD && VFD_TEST_LOGO */
334 
335 #ifdef CONFIG_BOOTCOUNT_LIMIT
336 	bootcount = bootcount_load();
337 	bootcount++;
338 	bootcount_store (bootcount);
339 	sprintf (bcs_set, "%lu", bootcount);
340 	setenv ("bootcount", bcs_set);
341 	bcs = getenv ("bootlimit");
342 	bootlimit = bcs ? simple_strtoul (bcs, NULL, 10) : 0;
343 #endif /* CONFIG_BOOTCOUNT_LIMIT */
344 
345 #ifdef CONFIG_MODEM_SUPPORT
346 	debug ("DEBUG: main_loop:   do_mdm_init=%d\n", do_mdm_init);
347 	if (do_mdm_init) {
348 		uchar *str = strdup(getenv("mdm_cmd"));
349 		setenv ("preboot", str);  /* set or delete definition */
350 		if (str != NULL)
351 			free (str);
352 		mdm_init(); /* wait for modem connection */
353 	}
354 #endif  /* CONFIG_MODEM_SUPPORT */
355 
356 #ifdef CONFIG_VERSION_VARIABLE
357 	{
358 		extern char version_string[];
359 
360 		setenv ("ver", version_string);  /* set version variable */
361 	}
362 #endif /* CONFIG_VERSION_VARIABLE */
363 
364 #ifdef CFG_HUSH_PARSER
365 	u_boot_hush_start ();
366 #endif
367 
368 #ifdef CONFIG_PREBOOT
369 	if ((p = getenv ("preboot")) != NULL) {
370 # ifdef CONFIG_AUTOBOOT_KEYED
371 		int prev = disable_ctrlc(1);	/* disable Control C checking */
372 # endif
373 
374 # ifndef CFG_HUSH_PARSER
375 		run_command (p, 0);
376 # else
377 		parse_string_outer(p, FLAG_PARSE_SEMICOLON |
378 				    FLAG_EXIT_FROM_LOOP);
379 # endif
380 
381 # ifdef CONFIG_AUTOBOOT_KEYED
382 		disable_ctrlc(prev);	/* restore Control C checking */
383 # endif
384 	}
385 #endif /* CONFIG_PREBOOT */
386 
387 #if defined(CONFIG_BOOTDELAY) && (CONFIG_BOOTDELAY >= 0)
388 	s = getenv ("bootdelay");
389 	bootdelay = s ? (int)simple_strtol(s, NULL, 10) : CONFIG_BOOTDELAY;
390 
391 	debug ("### main_loop entered: bootdelay=%d\n\n", bootdelay);
392 
393 # ifdef CONFIG_BOOT_RETRY_TIME
394 	init_cmd_timeout ();
395 # endif	/* CONFIG_BOOT_RETRY_TIME */
396 
397 #ifdef CONFIG_BOOTCOUNT_LIMIT
398 	if (bootlimit && (bootcount > bootlimit)) {
399 		printf ("Warning: Bootlimit (%u) exceeded. Using altbootcmd.\n",
400 		        (unsigned)bootlimit);
401 		s = getenv ("altbootcmd");
402 	}
403 	else
404 #endif /* CONFIG_BOOTCOUNT_LIMIT */
405 		s = getenv ("bootcmd");
406 
407 	debug ("### main_loop: bootcmd=\"%s\"\n", s ? s : "<UNDEFINED>");
408 
409 	if (bootdelay >= 0 && s && !abortboot (bootdelay)) {
410 # ifdef CONFIG_AUTOBOOT_KEYED
411 		int prev = disable_ctrlc(1);	/* disable Control C checking */
412 # endif
413 
414 # ifndef CFG_HUSH_PARSER
415 		run_command (s, 0);
416 # else
417 		parse_string_outer(s, FLAG_PARSE_SEMICOLON |
418 				    FLAG_EXIT_FROM_LOOP);
419 # endif
420 
421 # ifdef CONFIG_AUTOBOOT_KEYED
422 		disable_ctrlc(prev);	/* restore Control C checking */
423 # endif
424 	}
425 
426 # ifdef CONFIG_MENUKEY
427 	if (menukey == CONFIG_MENUKEY) {
428 	    s = getenv("menucmd");
429 	    if (s) {
430 # ifndef CFG_HUSH_PARSER
431 		run_command (s, bd, 0);
432 # else
433 		parse_string_outer(s, FLAG_PARSE_SEMICOLON |
434 				    FLAG_EXIT_FROM_LOOP);
435 # endif
436 	    }
437 	}
438 #endif /* CONFIG_MENUKEY */
439 #endif	/* CONFIG_BOOTDELAY */
440 
441 #ifdef CONFIG_AMIGAONEG3SE
442 	{
443 	    extern void video_banner(void);
444 	    video_banner();
445 	}
446 #endif
447 
448 	/*
449 	 * Main Loop for Monitor Command Processing
450 	 */
451 #ifdef CFG_HUSH_PARSER
452 	parse_file_outer();
453 	/* This point is never reached */
454 	for (;;);
455 #else
456 	for (;;) {
457 #ifdef CONFIG_BOOT_RETRY_TIME
458 		if (rc >= 0) {
459 			/* Saw enough of a valid command to
460 			 * restart the timeout.
461 			 */
462 			reset_cmd_timeout();
463 		}
464 #endif
465 		len = readline (CFG_PROMPT);
466 
467 		flag = 0;	/* assume no special flags for now */
468 		if (len > 0)
469 			strcpy (lastcommand, console_buffer);
470 		else if (len == 0)
471 			flag |= CMD_FLAG_REPEAT;
472 #ifdef CONFIG_BOOT_RETRY_TIME
473 		else if (len == -2) {
474 			/* -2 means timed out, retry autoboot
475 			 */
476 			printf("\nTimed out waiting for command\n");
477 # ifdef CONFIG_RESET_TO_RETRY
478 			/* Reinit board to run initialization code again */
479 			do_reset (NULL, 0, 0, NULL);
480 # else
481 			return;		/* retry autoboot */
482 # endif
483 		}
484 #endif
485 
486 		if (len == -1)
487 			printf ("<INTERRUPT>\n");
488 		else
489 			rc = run_command (lastcommand, flag);
490 
491 		if (rc <= 0) {
492 			/* invalid command or not repeatable, forget it */
493 			lastcommand[0] = 0;
494 		}
495 	}
496 #endif /*CFG_HUSH_PARSER*/
497 }
498 
499 #ifdef CONFIG_BOOT_RETRY_TIME
500 /***************************************************************************
501  * initialise command line timeout
502  */
503 void init_cmd_timeout(void)
504 {
505 	char *s = getenv ("bootretry");
506 
507 	if (s != NULL)
508 		retry_time = (int)simple_strtol(s, NULL, 10);
509 	else
510 		retry_time =  CONFIG_BOOT_RETRY_TIME;
511 
512 	if (retry_time >= 0 && retry_time < CONFIG_BOOT_RETRY_MIN)
513 		retry_time = CONFIG_BOOT_RETRY_MIN;
514 }
515 
516 /***************************************************************************
517  * reset command line timeout to retry_time seconds
518  */
519 void reset_cmd_timeout(void)
520 {
521 	endtime = endtick(retry_time);
522 }
523 #endif
524 
525 /****************************************************************************/
526 
527 /*
528  * Prompt for input and read a line.
529  * If  CONFIG_BOOT_RETRY_TIME is defined and retry_time >= 0,
530  * time out when time goes past endtime (timebase time in ticks).
531  * Return:	number of read characters
532  *		-1 if break
533  *		-2 if timed out
534  */
535 int readline (const char *const prompt)
536 {
537 	char   *p = console_buffer;
538 	int	n = 0;				/* buffer index		*/
539 	int	plen = 0;			/* prompt length	*/
540 	int	col;				/* output column cnt	*/
541 	char	c;
542 
543 	/* print prompt */
544 	if (prompt) {
545 		plen = strlen (prompt);
546 		puts (prompt);
547 	}
548 	col = plen;
549 
550 	for (;;) {
551 #ifdef CONFIG_BOOT_RETRY_TIME
552 		while (!tstc()) {	/* while no incoming data */
553 			if (retry_time >= 0 && get_ticks() > endtime)
554 				return (-2);	/* timed out */
555 		}
556 #endif
557 		WATCHDOG_RESET();		/* Trigger watchdog, if needed */
558 
559 #ifdef CONFIG_SHOW_ACTIVITY
560 		while (!tstc()) {
561 			extern void show_activity(int arg);
562 			show_activity(0);
563 		}
564 #endif
565 		c = getc();
566 
567 		/*
568 		 * Special character handling
569 		 */
570 		switch (c) {
571 		case '\r':				/* Enter		*/
572 		case '\n':
573 			*p = '\0';
574 			puts ("\r\n");
575 			return (p - console_buffer);
576 
577 		case 0x03:				/* ^C - break		*/
578 			console_buffer[0] = '\0';	/* discard input */
579 			return (-1);
580 
581 		case 0x15:				/* ^U - erase line	*/
582 			while (col > plen) {
583 				puts (erase_seq);
584 				--col;
585 			}
586 			p = console_buffer;
587 			n = 0;
588 			continue;
589 
590 		case 0x17:				/* ^W - erase word 	*/
591 			p=delete_char(console_buffer, p, &col, &n, plen);
592 			while ((n > 0) && (*p != ' ')) {
593 				p=delete_char(console_buffer, p, &col, &n, plen);
594 			}
595 			continue;
596 
597 		case 0x08:				/* ^H  - backspace	*/
598 		case 0x7F:				/* DEL - backspace	*/
599 			p=delete_char(console_buffer, p, &col, &n, plen);
600 			continue;
601 
602 		default:
603 			/*
604 			 * Must be a normal character then
605 			 */
606 			if (n < CFG_CBSIZE-2) {
607 				if (c == '\t') {	/* expand TABs		*/
608 					puts (tab_seq+(col&07));
609 					col += 8 - (col&07);
610 				} else {
611 					++col;		/* echo input		*/
612 					putc (c);
613 				}
614 				*p++ = c;
615 				++n;
616 			} else {			/* Buffer full		*/
617 				putc ('\a');
618 			}
619 		}
620 	}
621 }
622 
623 /****************************************************************************/
624 
625 static char * delete_char (char *buffer, char *p, int *colp, int *np, int plen)
626 {
627 	char *s;
628 
629 	if (*np == 0) {
630 		return (p);
631 	}
632 
633 	if (*(--p) == '\t') {			/* will retype the whole line	*/
634 		while (*colp > plen) {
635 			puts (erase_seq);
636 			(*colp)--;
637 		}
638 		for (s=buffer; s<p; ++s) {
639 			if (*s == '\t') {
640 				puts (tab_seq+((*colp) & 07));
641 				*colp += 8 - ((*colp) & 07);
642 			} else {
643 				++(*colp);
644 				putc (*s);
645 			}
646 		}
647 	} else {
648 		puts (erase_seq);
649 		(*colp)--;
650 	}
651 	(*np)--;
652 	return (p);
653 }
654 
655 /****************************************************************************/
656 
657 int parse_line (char *line, char *argv[])
658 {
659 	int nargs = 0;
660 
661 #ifdef DEBUG_PARSER
662 	printf ("parse_line: \"%s\"\n", line);
663 #endif
664 	while (nargs < CFG_MAXARGS) {
665 
666 		/* skip any white space */
667 		while ((*line == ' ') || (*line == '\t')) {
668 			++line;
669 		}
670 
671 		if (*line == '\0') {	/* end of line, no more args	*/
672 			argv[nargs] = NULL;
673 #ifdef DEBUG_PARSER
674 		printf ("parse_line: nargs=%d\n", nargs);
675 #endif
676 			return (nargs);
677 		}
678 
679 		argv[nargs++] = line;	/* begin of argument string	*/
680 
681 		/* find end of string */
682 		while (*line && (*line != ' ') && (*line != '\t')) {
683 			++line;
684 		}
685 
686 		if (*line == '\0') {	/* end of line, no more args	*/
687 			argv[nargs] = NULL;
688 #ifdef DEBUG_PARSER
689 		printf ("parse_line: nargs=%d\n", nargs);
690 #endif
691 			return (nargs);
692 		}
693 
694 		*line++ = '\0';		/* terminate current arg	 */
695 	}
696 
697 	printf ("** Too many args (max. %d) **\n", CFG_MAXARGS);
698 
699 #ifdef DEBUG_PARSER
700 	printf ("parse_line: nargs=%d\n", nargs);
701 #endif
702 	return (nargs);
703 }
704 
705 /****************************************************************************/
706 
707 static void process_macros (const char *input, char *output)
708 {
709 	char c, prev;
710 	const char *varname_start = NULL;
711 	int inputcnt  = strlen (input);
712 	int outputcnt = CFG_CBSIZE;
713 	int state = 0;	/* 0 = waiting for '$'	*/
714 			/* 1 = waiting for '('	*/
715 			/* 2 = waiting for ')'	*/
716 			/* 3 = waiting for '''  */
717 #ifdef DEBUG_PARSER
718 	char *output_start = output;
719 
720 	printf ("[PROCESS_MACROS] INPUT len %d: \"%s\"\n", strlen(input), input);
721 #endif
722 
723 	prev = '\0';			/* previous character	*/
724 
725 	while (inputcnt && outputcnt) {
726 	    c = *input++;
727 	    inputcnt--;
728 
729 	    if (state!=3) {
730 	    /* remove one level of escape characters */
731 	    if ((c == '\\') && (prev != '\\')) {
732 		if (inputcnt-- == 0)
733 			break;
734 		prev = c;
735 		c = *input++;
736 	    }
737 	    }
738 
739 	    switch (state) {
740 	    case 0:			/* Waiting for (unescaped) $	*/
741 		if ((c == '\'') && (prev != '\\')) {
742 			state = 3;
743 			break;
744 		}
745 		if ((c == '$') && (prev != '\\')) {
746 			state++;
747 		} else {
748 			*(output++) = c;
749 			outputcnt--;
750 		}
751 		break;
752 	    case 1:			/* Waiting for (	*/
753 		if (c == '(') {
754 			state++;
755 			varname_start = input;
756 		} else {
757 			state = 0;
758 			*(output++) = '$';
759 			outputcnt--;
760 
761 			if (outputcnt) {
762 				*(output++) = c;
763 				outputcnt--;
764 			}
765 		}
766 		break;
767 	    case 2:			/* Waiting for )	*/
768 		if (c == ')') {
769 			int i;
770 			char envname[CFG_CBSIZE], *envval;
771 			int envcnt = input-varname_start-1; /* Varname # of chars */
772 
773 			/* Get the varname */
774 			for (i = 0; i < envcnt; i++) {
775 				envname[i] = varname_start[i];
776 			}
777 			envname[i] = 0;
778 
779 			/* Get its value */
780 			envval = getenv (envname);
781 
782 			/* Copy into the line if it exists */
783 			if (envval != NULL)
784 				while ((*envval) && outputcnt) {
785 					*(output++) = *(envval++);
786 					outputcnt--;
787 				}
788 			/* Look for another '$' */
789 			state = 0;
790 		}
791 		break;
792 	    case 3:			/* Waiting for '	*/
793 		if ((c == '\'') && (prev != '\\')) {
794 			state = 0;
795 		} else {
796 			*(output++) = c;
797 			outputcnt--;
798 		}
799 		break;
800 	    }
801 	    prev = c;
802 	}
803 
804 	if (outputcnt)
805 		*output = 0;
806 
807 #ifdef DEBUG_PARSER
808 	printf ("[PROCESS_MACROS] OUTPUT len %d: \"%s\"\n",
809 		strlen(output_start), output_start);
810 #endif
811 }
812 
813 /****************************************************************************
814  * returns:
815  *	1  - command executed, repeatable
816  *	0  - command executed but not repeatable, interrupted commands are
817  *	     always considered not repeatable
818  *	-1 - not executed (unrecognized, bootd recursion or too many args)
819  *           (If cmd is NULL or "" or longer than CFG_CBSIZE-1 it is
820  *           considered unrecognized)
821  *
822  * WARNING:
823  *
824  * We must create a temporary copy of the command since the command we get
825  * may be the result from getenv(), which returns a pointer directly to
826  * the environment data, which may change magicly when the command we run
827  * creates or modifies environment variables (like "bootp" does).
828  */
829 
830 int run_command (const char *cmd, int flag)
831 {
832 	cmd_tbl_t *cmdtp;
833 	char cmdbuf[CFG_CBSIZE];	/* working copy of cmd		*/
834 	char *token;			/* start of token in cmdbuf	*/
835 	char *sep;			/* end of token (separator) in cmdbuf */
836 	char finaltoken[CFG_CBSIZE];
837 	char *str = cmdbuf;
838 	char *argv[CFG_MAXARGS + 1];	/* NULL terminated	*/
839 	int argc, inquotes;
840 	int repeatable = 1;
841 	int rc = 0;
842 
843 #ifdef DEBUG_PARSER
844 	printf ("[RUN_COMMAND] cmd[%p]=\"", cmd);
845 	puts (cmd ? cmd : "NULL");	/* use puts - string may be loooong */
846 	puts ("\"\n");
847 #endif
848 
849 	clear_ctrlc();		/* forget any previous Control C */
850 
851 	if (!cmd || !*cmd) {
852 		return -1;	/* empty command */
853 	}
854 
855 	if (strlen(cmd) >= CFG_CBSIZE) {
856 		puts ("## Command too long!\n");
857 		return -1;
858 	}
859 
860 	strcpy (cmdbuf, cmd);
861 
862 	/* Process separators and check for invalid
863 	 * repeatable commands
864 	 */
865 
866 #ifdef DEBUG_PARSER
867 	printf ("[PROCESS_SEPARATORS] %s\n", cmd);
868 #endif
869 	while (*str) {
870 
871 		/*
872 		 * Find separator, or string end
873 		 * Allow simple escape of ';' by writing "\;"
874 		 */
875 		for (inquotes = 0, sep = str; *sep; sep++) {
876 			if ((*sep=='\'') &&
877 			    (*(sep-1) != '\\'))
878 				inquotes=!inquotes;
879 
880 			if (!inquotes &&
881 			    (*sep == ';') &&	/* separator		*/
882 			    ( sep != str) &&	/* past string start	*/
883 			    (*(sep-1) != '\\'))	/* and NOT escaped	*/
884 				break;
885 		}
886 
887 		/*
888 		 * Limit the token to data between separators
889 		 */
890 		token = str;
891 		if (*sep) {
892 			str = sep + 1;	/* start of command for next pass */
893 			*sep = '\0';
894 		}
895 		else
896 			str = sep;	/* no more commands for next pass */
897 #ifdef DEBUG_PARSER
898 		printf ("token: \"%s\"\n", token);
899 #endif
900 
901 		/* find macros in this token and replace them */
902 		process_macros (token, finaltoken);
903 
904 		/* Extract arguments */
905 		argc = parse_line (finaltoken, argv);
906 
907 		/* Look up command in command table */
908 		if ((cmdtp = find_cmd(argv[0])) == NULL) {
909 			printf ("Unknown command '%s' - try 'help'\n", argv[0]);
910 			rc = -1;	/* give up after bad command */
911 			continue;
912 		}
913 
914 		/* found - check max args */
915 		if (argc > cmdtp->maxargs) {
916 			printf ("Usage:\n%s\n", cmdtp->usage);
917 			rc = -1;
918 			continue;
919 		}
920 
921 #if (CONFIG_COMMANDS & CFG_CMD_BOOTD)
922 		/* avoid "bootd" recursion */
923 		if (cmdtp->cmd == do_bootd) {
924 #ifdef DEBUG_PARSER
925 			printf ("[%s]\n", finaltoken);
926 #endif
927 			if (flag & CMD_FLAG_BOOTD) {
928 				printf ("'bootd' recursion detected\n");
929 				rc = -1;
930 				continue;
931 			}
932 			else
933 				flag |= CMD_FLAG_BOOTD;
934 		}
935 #endif	/* CFG_CMD_BOOTD */
936 
937 		/* OK - call function to do the command */
938 		if ((cmdtp->cmd) (cmdtp, flag, argc, argv) != 0) {
939 			rc = -1;
940 		}
941 
942 		repeatable &= cmdtp->repeatable;
943 
944 		/* Did the user stop this? */
945 		if (had_ctrlc ())
946 			return 0;	/* if stopped then not repeatable */
947 	}
948 
949 	return rc ? rc : repeatable;
950 }
951 
952 /****************************************************************************/
953 
954 #if (CONFIG_COMMANDS & CFG_CMD_RUN)
955 int do_run (cmd_tbl_t * cmdtp, int flag, int argc, char *argv[])
956 {
957 	int i;
958 
959 	if (argc < 2) {
960 		printf ("Usage:\n%s\n", cmdtp->usage);
961 		return 1;
962 	}
963 
964 	for (i=1; i<argc; ++i) {
965 		char *arg;
966 
967 		if ((arg = getenv (argv[i])) == NULL) {
968 			printf ("## Error: \"%s\" not defined\n", argv[i]);
969 			return 1;
970 		}
971 #ifndef CFG_HUSH_PARSER
972 		if (run_command (arg, flag) == -1)
973 			return 1;
974 #else
975 		if (parse_string_outer(arg,
976 		    FLAG_PARSE_SEMICOLON | FLAG_EXIT_FROM_LOOP) != 0)
977 			return 1;
978 #endif
979 	}
980 	return 0;
981 }
982 #endif	/* CFG_CMD_RUN */
983