xref: /rk3399_rockchip-uboot/common/main.c (revision f923943843cd617d681387e7fe81a48060cc6401)
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 wlen;
719 	char ichar;
720 	int insert = 1;
721 	int esc_len = 0;
722 	char esc_save[8];
723 
724 	while (1) {
725 #ifdef CONFIG_BOOT_RETRY_TIME
726 		while (!tstc()) {	/* while no incoming data */
727 			if (retry_time >= 0 && get_ticks() > endtime)
728 				return (-2);	/* timed out */
729 		}
730 #endif
731 
732 		ichar = getcmd_getch();
733 
734 		if ((ichar == '\n') || (ichar == '\r')) {
735 			putc('\n');
736 			break;
737 		}
738 
739 		/*
740 		 * handle standard linux xterm esc sequences for arrow key, etc.
741 		 */
742 		if (esc_len != 0) {
743 			if (esc_len == 1) {
744 				if (ichar == '[') {
745 					esc_save[esc_len] = ichar;
746 					esc_len = 2;
747 				} else {
748 					cread_add_str(esc_save, esc_len, insert,
749 						      &num, &eol_num, buf, *len);
750 					esc_len = 0;
751 				}
752 				continue;
753 			}
754 
755 			switch (ichar) {
756 
757 			case 'D':	/* <- key */
758 				ichar = CTL_CH('b');
759 				esc_len = 0;
760 				break;
761 			case 'C':	/* -> key */
762 				ichar = CTL_CH('f');
763 				esc_len = 0;
764 				break;	/* pass off to ^F handler */
765 			case 'H':	/* Home key */
766 				ichar = CTL_CH('a');
767 				esc_len = 0;
768 				break;	/* pass off to ^A handler */
769 			case 'A':	/* up arrow */
770 				ichar = CTL_CH('p');
771 				esc_len = 0;
772 				break;	/* pass off to ^P handler */
773 			case 'B':	/* down arrow */
774 				ichar = CTL_CH('n');
775 				esc_len = 0;
776 				break;	/* pass off to ^N handler */
777 			default:
778 				esc_save[esc_len++] = ichar;
779 				cread_add_str(esc_save, esc_len, insert,
780 					      &num, &eol_num, buf, *len);
781 				esc_len = 0;
782 				continue;
783 			}
784 		}
785 
786 		switch (ichar) {
787 		case 0x1b:
788 			if (esc_len == 0) {
789 				esc_save[esc_len] = ichar;
790 				esc_len = 1;
791 			} else {
792 				puts("impossible condition #876\n");
793 				esc_len = 0;
794 			}
795 			break;
796 
797 		case CTL_CH('a'):
798 			BEGINNING_OF_LINE();
799 			break;
800 		case CTL_CH('c'):	/* ^C - break */
801 			*buf = '\0';	/* discard input */
802 			return (-1);
803 		case CTL_CH('f'):
804 			if (num < eol_num) {
805 				getcmd_putch(buf[num]);
806 				num++;
807 			}
808 			break;
809 		case CTL_CH('b'):
810 			if (num) {
811 				getcmd_putch(CTL_BACKSPACE);
812 				num--;
813 			}
814 			break;
815 		case CTL_CH('d'):
816 			if (num < eol_num) {
817 				wlen = eol_num - num - 1;
818 				if (wlen) {
819 					memmove(&buf[num], &buf[num+1], wlen);
820 					putnstr(buf + num, wlen);
821 				}
822 
823 				getcmd_putch(' ');
824 				do {
825 					getcmd_putch(CTL_BACKSPACE);
826 				} while (wlen--);
827 				eol_num--;
828 			}
829 			break;
830 		case CTL_CH('k'):
831 			ERASE_TO_EOL();
832 			break;
833 		case CTL_CH('e'):
834 			REFRESH_TO_EOL();
835 			break;
836 		case CTL_CH('o'):
837 			insert = !insert;
838 			break;
839 		case CTL_CH('x'):
840 		case CTL_CH('u'):
841 			BEGINNING_OF_LINE();
842 			ERASE_TO_EOL();
843 			break;
844 		case DEL:
845 		case DEL7:
846 		case 8:
847 			if (num) {
848 				wlen = eol_num - num;
849 				num--;
850 				memmove(&buf[num], &buf[num+1], wlen);
851 				getcmd_putch(CTL_BACKSPACE);
852 				putnstr(buf + num, wlen);
853 				getcmd_putch(' ');
854 				do {
855 					getcmd_putch(CTL_BACKSPACE);
856 				} while (wlen--);
857 				eol_num--;
858 			}
859 			break;
860 		case CTL_CH('p'):
861 		case CTL_CH('n'):
862 		{
863 			char * hline;
864 
865 			esc_len = 0;
866 
867 			if (ichar == CTL_CH('p'))
868 				hline = hist_prev();
869 			else
870 				hline = hist_next();
871 
872 			if (!hline) {
873 				getcmd_cbeep();
874 				continue;
875 			}
876 
877 			/* nuke the current line */
878 			/* first, go home */
879 			BEGINNING_OF_LINE();
880 
881 			/* erase to end of line */
882 			ERASE_TO_EOL();
883 
884 			/* copy new line into place and display */
885 			strcpy(buf, hline);
886 			eol_num = strlen(buf);
887 			REFRESH_TO_EOL();
888 			continue;
889 		}
890 #ifdef CONFIG_AUTO_COMPLETE
891 		case '\t': {
892 			int num2, col;
893 
894 			/* do not autocomplete when in the middle */
895 			if (num < eol_num) {
896 				getcmd_cbeep();
897 				break;
898 			}
899 
900 			buf[num] = '\0';
901 			col = strlen(prompt) + eol_num;
902 			num2 = num;
903 			if (cmd_auto_complete(prompt, buf, &num2, &col)) {
904 				col = num2 - num;
905 				num += col;
906 				eol_num += col;
907 			}
908 			break;
909 		}
910 #endif
911 		default:
912 			cread_add_char(ichar, insert, &num, &eol_num, buf, *len);
913 			break;
914 		}
915 	}
916 	*len = eol_num;
917 	buf[eol_num] = '\0';	/* lose the newline */
918 
919 	if (buf[0] && buf[0] != CREAD_HIST_CHAR)
920 		cread_add_to_hist(buf);
921 	hist_cur = hist_add_idx;
922 
923 	return 0;
924 }
925 
926 #endif /* CONFIG_CMDLINE_EDITING */
927 
928 /****************************************************************************/
929 
930 /*
931  * Prompt for input and read a line.
932  * If  CONFIG_BOOT_RETRY_TIME is defined and retry_time >= 0,
933  * time out when time goes past endtime (timebase time in ticks).
934  * Return:	number of read characters
935  *		-1 if break
936  *		-2 if timed out
937  */
938 int readline (const char *const prompt)
939 {
940 	return readline_into_buffer(prompt, console_buffer);
941 }
942 
943 
944 int readline_into_buffer (const char *const prompt, char * buffer)
945 {
946 	char *p = buffer;
947 #ifdef CONFIG_CMDLINE_EDITING
948 	unsigned int len=MAX_CMDBUF_SIZE;
949 	int rc;
950 	static int initted = 0;
951 
952 	/*
953 	 * History uses a global array which is not
954 	 * writable until after relocation to RAM.
955 	 * Revert to non-history version if still
956 	 * running from flash.
957 	 */
958 	if (gd->flags & GD_FLG_RELOC) {
959 		if (!initted) {
960 			hist_init();
961 			initted = 1;
962 		}
963 
964 		if (prompt)
965 			puts (prompt);
966 
967 		rc = cread_line(prompt, p, &len);
968 		return rc < 0 ? rc : len;
969 
970 	} else {
971 #endif	/* CONFIG_CMDLINE_EDITING */
972 	char * p_buf = p;
973 	int	n = 0;				/* buffer index		*/
974 	int	plen = 0;			/* prompt length	*/
975 	int	col;				/* output column cnt	*/
976 	char	c;
977 
978 	/* print prompt */
979 	if (prompt) {
980 		plen = strlen (prompt);
981 		puts (prompt);
982 	}
983 	col = plen;
984 
985 	for (;;) {
986 #ifdef CONFIG_BOOT_RETRY_TIME
987 		while (!tstc()) {	/* while no incoming data */
988 			if (retry_time >= 0 && get_ticks() > endtime)
989 				return (-2);	/* timed out */
990 		}
991 #endif
992 		WATCHDOG_RESET();		/* Trigger watchdog, if needed */
993 
994 #ifdef CONFIG_SHOW_ACTIVITY
995 		while (!tstc()) {
996 			extern void show_activity(int arg);
997 			show_activity(0);
998 		}
999 #endif
1000 		c = getc();
1001 
1002 		/*
1003 		 * Special character handling
1004 		 */
1005 		switch (c) {
1006 		case '\r':				/* Enter		*/
1007 		case '\n':
1008 			*p = '\0';
1009 			puts ("\r\n");
1010 			return (p - p_buf);
1011 
1012 		case '\0':				/* nul			*/
1013 			continue;
1014 
1015 		case 0x03:				/* ^C - break		*/
1016 			p_buf[0] = '\0';	/* discard input */
1017 			return (-1);
1018 
1019 		case 0x15:				/* ^U - erase line	*/
1020 			while (col > plen) {
1021 				puts (erase_seq);
1022 				--col;
1023 			}
1024 			p = p_buf;
1025 			n = 0;
1026 			continue;
1027 
1028 		case 0x17:				/* ^W - erase word	*/
1029 			p=delete_char(p_buf, p, &col, &n, plen);
1030 			while ((n > 0) && (*p != ' ')) {
1031 				p=delete_char(p_buf, p, &col, &n, plen);
1032 			}
1033 			continue;
1034 
1035 		case 0x08:				/* ^H  - backspace	*/
1036 		case 0x7F:				/* DEL - backspace	*/
1037 			p=delete_char(p_buf, p, &col, &n, plen);
1038 			continue;
1039 
1040 		default:
1041 			/*
1042 			 * Must be a normal character then
1043 			 */
1044 			if (n < CONFIG_SYS_CBSIZE-2) {
1045 				if (c == '\t') {	/* expand TABs		*/
1046 #ifdef CONFIG_AUTO_COMPLETE
1047 					/* if auto completion triggered just continue */
1048 					*p = '\0';
1049 					if (cmd_auto_complete(prompt, console_buffer, &n, &col)) {
1050 						p = p_buf + n;	/* reset */
1051 						continue;
1052 					}
1053 #endif
1054 					puts (tab_seq+(col&07));
1055 					col += 8 - (col&07);
1056 				} else {
1057 					++col;		/* echo input		*/
1058 					putc (c);
1059 				}
1060 				*p++ = c;
1061 				++n;
1062 			} else {			/* Buffer full		*/
1063 				putc ('\a');
1064 			}
1065 		}
1066 	}
1067 #ifdef CONFIG_CMDLINE_EDITING
1068 	}
1069 #endif
1070 }
1071 
1072 /****************************************************************************/
1073 
1074 static char * delete_char (char *buffer, char *p, int *colp, int *np, int plen)
1075 {
1076 	char *s;
1077 
1078 	if (*np == 0) {
1079 		return (p);
1080 	}
1081 
1082 	if (*(--p) == '\t') {			/* will retype the whole line	*/
1083 		while (*colp > plen) {
1084 			puts (erase_seq);
1085 			(*colp)--;
1086 		}
1087 		for (s=buffer; s<p; ++s) {
1088 			if (*s == '\t') {
1089 				puts (tab_seq+((*colp) & 07));
1090 				*colp += 8 - ((*colp) & 07);
1091 			} else {
1092 				++(*colp);
1093 				putc (*s);
1094 			}
1095 		}
1096 	} else {
1097 		puts (erase_seq);
1098 		(*colp)--;
1099 	}
1100 	(*np)--;
1101 	return (p);
1102 }
1103 
1104 /****************************************************************************/
1105 
1106 int parse_line (char *line, char *argv[])
1107 {
1108 	int nargs = 0;
1109 
1110 #ifdef DEBUG_PARSER
1111 	printf ("parse_line: \"%s\"\n", line);
1112 #endif
1113 	while (nargs < CONFIG_SYS_MAXARGS) {
1114 
1115 		/* skip any white space */
1116 		while ((*line == ' ') || (*line == '\t')) {
1117 			++line;
1118 		}
1119 
1120 		if (*line == '\0') {	/* end of line, no more args	*/
1121 			argv[nargs] = NULL;
1122 #ifdef DEBUG_PARSER
1123 		printf ("parse_line: nargs=%d\n", nargs);
1124 #endif
1125 			return (nargs);
1126 		}
1127 
1128 		argv[nargs++] = line;	/* begin of argument string	*/
1129 
1130 		/* find end of string */
1131 		while (*line && (*line != ' ') && (*line != '\t')) {
1132 			++line;
1133 		}
1134 
1135 		if (*line == '\0') {	/* end of line, no more args	*/
1136 			argv[nargs] = NULL;
1137 #ifdef DEBUG_PARSER
1138 		printf ("parse_line: nargs=%d\n", nargs);
1139 #endif
1140 			return (nargs);
1141 		}
1142 
1143 		*line++ = '\0';		/* terminate current arg	 */
1144 	}
1145 
1146 	printf ("** Too many args (max. %d) **\n", CONFIG_SYS_MAXARGS);
1147 
1148 #ifdef DEBUG_PARSER
1149 	printf ("parse_line: nargs=%d\n", nargs);
1150 #endif
1151 	return (nargs);
1152 }
1153 
1154 /****************************************************************************/
1155 
1156 static void process_macros (const char *input, char *output)
1157 {
1158 	char c, prev;
1159 	const char *varname_start = NULL;
1160 	int inputcnt = strlen (input);
1161 	int outputcnt = CONFIG_SYS_CBSIZE;
1162 	int state = 0;		/* 0 = waiting for '$'  */
1163 
1164 	/* 1 = waiting for '(' or '{' */
1165 	/* 2 = waiting for ')' or '}' */
1166 	/* 3 = waiting for '''  */
1167 #ifdef DEBUG_PARSER
1168 	char *output_start = output;
1169 
1170 	printf ("[PROCESS_MACROS] INPUT len %d: \"%s\"\n", strlen (input),
1171 		input);
1172 #endif
1173 
1174 	prev = '\0';		/* previous character   */
1175 
1176 	while (inputcnt && outputcnt) {
1177 		c = *input++;
1178 		inputcnt--;
1179 
1180 		if (state != 3) {
1181 			/* remove one level of escape characters */
1182 			if ((c == '\\') && (prev != '\\')) {
1183 				if (inputcnt-- == 0)
1184 					break;
1185 				prev = c;
1186 				c = *input++;
1187 			}
1188 		}
1189 
1190 		switch (state) {
1191 		case 0:	/* Waiting for (unescaped) $    */
1192 			if ((c == '\'') && (prev != '\\')) {
1193 				state = 3;
1194 				break;
1195 			}
1196 			if ((c == '$') && (prev != '\\')) {
1197 				state++;
1198 			} else {
1199 				*(output++) = c;
1200 				outputcnt--;
1201 			}
1202 			break;
1203 		case 1:	/* Waiting for (        */
1204 			if (c == '(' || c == '{') {
1205 				state++;
1206 				varname_start = input;
1207 			} else {
1208 				state = 0;
1209 				*(output++) = '$';
1210 				outputcnt--;
1211 
1212 				if (outputcnt) {
1213 					*(output++) = c;
1214 					outputcnt--;
1215 				}
1216 			}
1217 			break;
1218 		case 2:	/* Waiting for )        */
1219 			if (c == ')' || c == '}') {
1220 				int i;
1221 				char envname[CONFIG_SYS_CBSIZE], *envval;
1222 				int envcnt = input - varname_start - 1;	/* Varname # of chars */
1223 
1224 				/* Get the varname */
1225 				for (i = 0; i < envcnt; i++) {
1226 					envname[i] = varname_start[i];
1227 				}
1228 				envname[i] = 0;
1229 
1230 				/* Get its value */
1231 				envval = getenv (envname);
1232 
1233 				/* Copy into the line if it exists */
1234 				if (envval != NULL)
1235 					while ((*envval) && outputcnt) {
1236 						*(output++) = *(envval++);
1237 						outputcnt--;
1238 					}
1239 				/* Look for another '$' */
1240 				state = 0;
1241 			}
1242 			break;
1243 		case 3:	/* Waiting for '        */
1244 			if ((c == '\'') && (prev != '\\')) {
1245 				state = 0;
1246 			} else {
1247 				*(output++) = c;
1248 				outputcnt--;
1249 			}
1250 			break;
1251 		}
1252 		prev = c;
1253 	}
1254 
1255 	if (outputcnt)
1256 		*output = 0;
1257 	else
1258 		*(output - 1) = 0;
1259 
1260 #ifdef DEBUG_PARSER
1261 	printf ("[PROCESS_MACROS] OUTPUT len %d: \"%s\"\n",
1262 		strlen (output_start), output_start);
1263 #endif
1264 }
1265 
1266 /****************************************************************************
1267  * returns:
1268  *	1  - command executed, repeatable
1269  *	0  - command executed but not repeatable, interrupted commands are
1270  *	     always considered not repeatable
1271  *	-1 - not executed (unrecognized, bootd recursion or too many args)
1272  *           (If cmd is NULL or "" or longer than CONFIG_SYS_CBSIZE-1 it is
1273  *           considered unrecognized)
1274  *
1275  * WARNING:
1276  *
1277  * We must create a temporary copy of the command since the command we get
1278  * may be the result from getenv(), which returns a pointer directly to
1279  * the environment data, which may change magicly when the command we run
1280  * creates or modifies environment variables (like "bootp" does).
1281  */
1282 
1283 int run_command (const char *cmd, int flag)
1284 {
1285 	cmd_tbl_t *cmdtp;
1286 	char cmdbuf[CONFIG_SYS_CBSIZE];	/* working copy of cmd		*/
1287 	char *token;			/* start of token in cmdbuf	*/
1288 	char *sep;			/* end of token (separator) in cmdbuf */
1289 	char finaltoken[CONFIG_SYS_CBSIZE];
1290 	char *str = cmdbuf;
1291 	char *argv[CONFIG_SYS_MAXARGS + 1];	/* NULL terminated	*/
1292 	int argc, inquotes;
1293 	int repeatable = 1;
1294 	int rc = 0;
1295 
1296 #ifdef DEBUG_PARSER
1297 	printf ("[RUN_COMMAND] cmd[%p]=\"", cmd);
1298 	puts (cmd ? cmd : "NULL");	/* use puts - string may be loooong */
1299 	puts ("\"\n");
1300 #endif
1301 
1302 	clear_ctrlc();		/* forget any previous Control C */
1303 
1304 	if (!cmd || !*cmd) {
1305 		return -1;	/* empty command */
1306 	}
1307 
1308 	if (strlen(cmd) >= CONFIG_SYS_CBSIZE) {
1309 		puts ("## Command too long!\n");
1310 		return -1;
1311 	}
1312 
1313 	strcpy (cmdbuf, cmd);
1314 
1315 	/* Process separators and check for invalid
1316 	 * repeatable commands
1317 	 */
1318 
1319 #ifdef DEBUG_PARSER
1320 	printf ("[PROCESS_SEPARATORS] %s\n", cmd);
1321 #endif
1322 	while (*str) {
1323 
1324 		/*
1325 		 * Find separator, or string end
1326 		 * Allow simple escape of ';' by writing "\;"
1327 		 */
1328 		for (inquotes = 0, sep = str; *sep; sep++) {
1329 			if ((*sep=='\'') &&
1330 			    (*(sep-1) != '\\'))
1331 				inquotes=!inquotes;
1332 
1333 			if (!inquotes &&
1334 			    (*sep == ';') &&	/* separator		*/
1335 			    ( sep != str) &&	/* past string start	*/
1336 			    (*(sep-1) != '\\'))	/* and NOT escaped	*/
1337 				break;
1338 		}
1339 
1340 		/*
1341 		 * Limit the token to data between separators
1342 		 */
1343 		token = str;
1344 		if (*sep) {
1345 			str = sep + 1;	/* start of command for next pass */
1346 			*sep = '\0';
1347 		}
1348 		else
1349 			str = sep;	/* no more commands for next pass */
1350 #ifdef DEBUG_PARSER
1351 		printf ("token: \"%s\"\n", token);
1352 #endif
1353 
1354 		/* find macros in this token and replace them */
1355 		process_macros (token, finaltoken);
1356 
1357 		/* Extract arguments */
1358 		if ((argc = parse_line (finaltoken, argv)) == 0) {
1359 			rc = -1;	/* no command at all */
1360 			continue;
1361 		}
1362 
1363 		/* Look up command in command table */
1364 		if ((cmdtp = find_cmd(argv[0])) == NULL) {
1365 			printf ("Unknown command '%s' - try 'help'\n", argv[0]);
1366 			rc = -1;	/* give up after bad command */
1367 			continue;
1368 		}
1369 
1370 		/* found - check max args */
1371 		if (argc > cmdtp->maxargs) {
1372 			cmd_usage(cmdtp);
1373 			rc = -1;
1374 			continue;
1375 		}
1376 
1377 #if defined(CONFIG_CMD_BOOTD)
1378 		/* avoid "bootd" recursion */
1379 		if (cmdtp->cmd == do_bootd) {
1380 #ifdef DEBUG_PARSER
1381 			printf ("[%s]\n", finaltoken);
1382 #endif
1383 			if (flag & CMD_FLAG_BOOTD) {
1384 				puts ("'bootd' recursion detected\n");
1385 				rc = -1;
1386 				continue;
1387 			} else {
1388 				flag |= CMD_FLAG_BOOTD;
1389 			}
1390 		}
1391 #endif
1392 
1393 		/* OK - call function to do the command */
1394 		if ((cmdtp->cmd) (cmdtp, flag, argc, argv) != 0) {
1395 			rc = -1;
1396 		}
1397 
1398 		repeatable &= cmdtp->repeatable;
1399 
1400 		/* Did the user stop this? */
1401 		if (had_ctrlc ())
1402 			return -1;	/* if stopped then not repeatable */
1403 	}
1404 
1405 	return rc ? rc : repeatable;
1406 }
1407 
1408 /****************************************************************************/
1409 
1410 #if defined(CONFIG_CMD_RUN)
1411 int do_run (cmd_tbl_t * cmdtp, int flag, int argc, char *argv[])
1412 {
1413 	int i;
1414 
1415 	if (argc < 2) {
1416 		cmd_usage(cmdtp);
1417 		return 1;
1418 	}
1419 
1420 	for (i=1; i<argc; ++i) {
1421 		char *arg;
1422 
1423 		if ((arg = getenv (argv[i])) == NULL) {
1424 			printf ("## Error: \"%s\" not defined\n", argv[i]);
1425 			return 1;
1426 		}
1427 #ifndef CONFIG_SYS_HUSH_PARSER
1428 		if (run_command (arg, flag) == -1)
1429 			return 1;
1430 #else
1431 		if (parse_string_outer(arg,
1432 		    FLAG_PARSE_SEMICOLON | FLAG_EXIT_FROM_LOOP) != 0)
1433 			return 1;
1434 #endif
1435 	}
1436 	return 0;
1437 }
1438 #endif
1439