main.c 30 KB

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