1
2
3
4
5
6
7
8
9
10
11
12#include <common.h>
13#include <bootretry.h>
14#include <cli.h>
15#include <watchdog.h>
16
17DECLARE_GLOBAL_DATA_PTR;
18
19static const char erase_seq[] = "\b \b";
20static const char tab_seq[] = " ";
21
22char console_buffer[CONFIG_SYS_CBSIZE + 1];
23
24static char *delete_char (char *buffer, char *p, int *colp, int *np, int plen)
25{
26 char *s;
27
28 if (*np == 0)
29 return p;
30
31 if (*(--p) == '\t') {
32 while (*colp > plen) {
33 puts(erase_seq);
34 (*colp)--;
35 }
36 for (s = buffer; s < p; ++s) {
37 if (*s == '\t') {
38 puts(tab_seq + ((*colp) & 07));
39 *colp += 8 - ((*colp) & 07);
40 } else {
41 ++(*colp);
42 putc(*s);
43 }
44 }
45 } else {
46 puts(erase_seq);
47 (*colp)--;
48 }
49 (*np)--;
50
51 return p;
52}
53
54#ifdef CONFIG_CMDLINE_EDITING
55
56
57
58
59
60
61#define putnstr(str, n) printf("%.*s", (int)n, str)
62
63#define CTL_CH(c) ((c) - 'a' + 1)
64#define CTL_BACKSPACE ('\b')
65#define DEL ((char)255)
66#define DEL7 ((char)127)
67#define CREAD_HIST_CHAR ('!')
68
69#define getcmd_putch(ch) putc(ch)
70#define getcmd_getch() getc()
71#define getcmd_cbeep() getcmd_putch('\a')
72
73#define HIST_MAX 20
74#define HIST_SIZE CONFIG_SYS_CBSIZE
75
76static int hist_max;
77static int hist_add_idx;
78static int hist_cur = -1;
79static unsigned hist_num;
80
81static char *hist_list[HIST_MAX];
82static char hist_lines[HIST_MAX][HIST_SIZE + 1];
83
84#define add_idx_minus_one() ((hist_add_idx == 0) ? hist_max : hist_add_idx-1)
85
86static void hist_init(void)
87{
88 int i;
89
90 hist_max = 0;
91 hist_add_idx = 0;
92 hist_cur = -1;
93 hist_num = 0;
94
95 for (i = 0; i < HIST_MAX; i++) {
96 hist_list[i] = hist_lines[i];
97 hist_list[i][0] = '\0';
98 }
99}
100
101static void cread_add_to_hist(char *line)
102{
103 strcpy(hist_list[hist_add_idx], line);
104
105 if (++hist_add_idx >= HIST_MAX)
106 hist_add_idx = 0;
107
108 if (hist_add_idx > hist_max)
109 hist_max = hist_add_idx;
110
111 hist_num++;
112}
113
114static char *hist_prev(void)
115{
116 char *ret;
117 int old_cur;
118
119 if (hist_cur < 0)
120 return NULL;
121
122 old_cur = hist_cur;
123 if (--hist_cur < 0)
124 hist_cur = hist_max;
125
126 if (hist_cur == hist_add_idx) {
127 hist_cur = old_cur;
128 ret = NULL;
129 } else {
130 ret = hist_list[hist_cur];
131 }
132
133 return ret;
134}
135
136static char *hist_next(void)
137{
138 char *ret;
139
140 if (hist_cur < 0)
141 return NULL;
142
143 if (hist_cur == hist_add_idx)
144 return NULL;
145
146 if (++hist_cur > hist_max)
147 hist_cur = 0;
148
149 if (hist_cur == hist_add_idx)
150 ret = "";
151 else
152 ret = hist_list[hist_cur];
153
154 return ret;
155}
156
157#ifndef CONFIG_CMDLINE_EDITING
158static void cread_print_hist_list(void)
159{
160 int i;
161 unsigned long n;
162
163 n = hist_num - hist_max;
164
165 i = hist_add_idx + 1;
166 while (1) {
167 if (i > hist_max)
168 i = 0;
169 if (i == hist_add_idx)
170 break;
171 printf("%s\n", hist_list[i]);
172 n++;
173 i++;
174 }
175}
176#endif
177
178#define BEGINNING_OF_LINE() { \
179 while (num) { \
180 getcmd_putch(CTL_BACKSPACE); \
181 num--; \
182 } \
183}
184
185#define ERASE_TO_EOL() { \
186 if (num < eol_num) { \
187 printf("%*s", (int)(eol_num - num), ""); \
188 do { \
189 getcmd_putch(CTL_BACKSPACE); \
190 } while (--eol_num > num); \
191 } \
192}
193
194#define REFRESH_TO_EOL() { \
195 if (num < eol_num) { \
196 wlen = eol_num - num; \
197 putnstr(buf + num, wlen); \
198 num = eol_num; \
199 } \
200}
201
202static void cread_add_char(char ichar, int insert, unsigned long *num,
203 unsigned long *eol_num, char *buf, unsigned long len)
204{
205 unsigned long wlen;
206
207
208 if (insert || *num == *eol_num) {
209 if (*eol_num > len - 1) {
210 getcmd_cbeep();
211 return;
212 }
213 (*eol_num)++;
214 }
215
216 if (insert) {
217 wlen = *eol_num - *num;
218 if (wlen > 1)
219 memmove(&buf[*num+1], &buf[*num], wlen-1);
220
221 buf[*num] = ichar;
222 putnstr(buf + *num, wlen);
223 (*num)++;
224 while (--wlen)
225 getcmd_putch(CTL_BACKSPACE);
226 } else {
227
228 wlen = 1;
229 buf[*num] = ichar;
230 putnstr(buf + *num, wlen);
231 (*num)++;
232 }
233}
234
235static void cread_add_str(char *str, int strsize, int insert,
236 unsigned long *num, unsigned long *eol_num,
237 char *buf, unsigned long len)
238{
239 while (strsize--) {
240 cread_add_char(*str, insert, num, eol_num, buf, len);
241 str++;
242 }
243}
244
245static int cread_line(const char *const prompt, char *buf, unsigned int *len,
246 int timeout)
247{
248 unsigned long num = 0;
249 unsigned long eol_num = 0;
250 unsigned long wlen;
251 char ichar;
252 int insert = 1;
253 int esc_len = 0;
254 char esc_save[8];
255 int init_len = strlen(buf);
256 int first = 1;
257
258 if (init_len)
259 cread_add_str(buf, init_len, 1, &num, &eol_num, buf, *len);
260
261 while (1) {
262 if (bootretry_tstc_timeout())
263 return -2;
264 if (first && timeout) {
265 uint64_t etime = endtick(timeout);
266
267 while (!tstc()) {
268 if (get_ticks() >= etime)
269 return -2;
270 WATCHDOG_RESET();
271 }
272 first = 0;
273 }
274
275 ichar = getcmd_getch();
276
277 if ((ichar == '\n') || (ichar == '\r')) {
278 putc('\n');
279 break;
280 }
281
282
283
284
285 if (esc_len != 0) {
286 enum { ESC_REJECT, ESC_SAVE, ESC_CONVERTED } act = ESC_REJECT;
287
288 if (esc_len == 1) {
289 if (ichar == '[' || ichar == 'O')
290 act = ESC_SAVE;
291 } else if (esc_len == 2) {
292 switch (ichar) {
293 case 'D':
294 ichar = CTL_CH('b');
295 act = ESC_CONVERTED;
296 break;
297 case 'C':
298 ichar = CTL_CH('f');
299 act = ESC_CONVERTED;
300 break;
301 case 'H':
302 ichar = CTL_CH('a');
303 act = ESC_CONVERTED;
304 break;
305 case 'F':
306 ichar = CTL_CH('e');
307 act = ESC_CONVERTED;
308 break;
309 case 'A':
310 ichar = CTL_CH('p');
311 act = ESC_CONVERTED;
312 break;
313 case 'B':
314 ichar = CTL_CH('n');
315 act = ESC_CONVERTED;
316 break;
317 case '1':
318 case '3':
319 case '4':
320 case '7':
321 case '8':
322 if (esc_save[1] == '[') {
323
324 act = ESC_SAVE;
325 }
326 break;
327 }
328 } else if (esc_len == 3) {
329 if (ichar == '~') {
330 switch (esc_save[2]) {
331 case '3':
332 ichar = CTL_CH('d');
333 act = ESC_CONVERTED;
334 break;
335 case '1':
336 case '7':
337 ichar = CTL_CH('a');
338 act = ESC_CONVERTED;
339 break;
340 case '4':
341 case '8':
342 ichar = CTL_CH('e');
343 act = ESC_CONVERTED;
344 break;
345 }
346 }
347 }
348
349 switch (act) {
350 case ESC_SAVE:
351 esc_save[esc_len++] = ichar;
352 continue;
353 case ESC_REJECT:
354 esc_save[esc_len++] = ichar;
355 cread_add_str(esc_save, esc_len, insert,
356 &num, &eol_num, buf, *len);
357 esc_len = 0;
358 continue;
359 case ESC_CONVERTED:
360 esc_len = 0;
361 break;
362 }
363 }
364
365 switch (ichar) {
366 case 0x1b:
367 if (esc_len == 0) {
368 esc_save[esc_len] = ichar;
369 esc_len = 1;
370 } else {
371 puts("impossible condition #876\n");
372 esc_len = 0;
373 }
374 break;
375
376 case CTL_CH('a'):
377 BEGINNING_OF_LINE();
378 break;
379 case CTL_CH('c'):
380 *buf = '\0';
381 return -1;
382 case CTL_CH('f'):
383 if (num < eol_num) {
384 getcmd_putch(buf[num]);
385 num++;
386 }
387 break;
388 case CTL_CH('b'):
389 if (num) {
390 getcmd_putch(CTL_BACKSPACE);
391 num--;
392 }
393 break;
394 case CTL_CH('d'):
395 if (num < eol_num) {
396 wlen = eol_num - num - 1;
397 if (wlen) {
398 memmove(&buf[num], &buf[num+1], wlen);
399 putnstr(buf + num, wlen);
400 }
401
402 getcmd_putch(' ');
403 do {
404 getcmd_putch(CTL_BACKSPACE);
405 } while (wlen--);
406 eol_num--;
407 }
408 break;
409 case CTL_CH('k'):
410 ERASE_TO_EOL();
411 break;
412 case CTL_CH('e'):
413 REFRESH_TO_EOL();
414 break;
415 case CTL_CH('o'):
416 insert = !insert;
417 break;
418 case CTL_CH('x'):
419 case CTL_CH('u'):
420 BEGINNING_OF_LINE();
421 ERASE_TO_EOL();
422 break;
423 case DEL:
424 case DEL7:
425 case 8:
426 if (num) {
427 wlen = eol_num - num;
428 num--;
429 memmove(&buf[num], &buf[num+1], wlen);
430 getcmd_putch(CTL_BACKSPACE);
431 putnstr(buf + num, wlen);
432 getcmd_putch(' ');
433 do {
434 getcmd_putch(CTL_BACKSPACE);
435 } while (wlen--);
436 eol_num--;
437 }
438 break;
439 case CTL_CH('p'):
440 case CTL_CH('n'):
441 {
442 char *hline;
443
444 esc_len = 0;
445
446 if (ichar == CTL_CH('p'))
447 hline = hist_prev();
448 else
449 hline = hist_next();
450
451 if (!hline) {
452 getcmd_cbeep();
453 continue;
454 }
455
456
457
458 BEGINNING_OF_LINE();
459
460
461 ERASE_TO_EOL();
462
463
464 strcpy(buf, hline);
465 eol_num = strlen(buf);
466 REFRESH_TO_EOL();
467 continue;
468 }
469#ifdef CONFIG_AUTO_COMPLETE
470 case '\t': {
471 int num2, col;
472
473
474 if (num < eol_num) {
475 getcmd_cbeep();
476 break;
477 }
478
479 buf[num] = '\0';
480 col = strlen(prompt) + eol_num;
481 num2 = num;
482 if (cmd_auto_complete(prompt, buf, &num2, &col)) {
483 col = num2 - num;
484 num += col;
485 eol_num += col;
486 }
487 break;
488 }
489#endif
490 default:
491 cread_add_char(ichar, insert, &num, &eol_num, buf,
492 *len);
493 break;
494 }
495 }
496 *len = eol_num;
497 buf[eol_num] = '\0';
498
499 if (buf[0] && buf[0] != CREAD_HIST_CHAR)
500 cread_add_to_hist(buf);
501 hist_cur = hist_add_idx;
502
503 return 0;
504}
505
506#endif
507
508
509
510int cli_readline(const char *const prompt)
511{
512
513
514
515
516 console_buffer[0] = '\0';
517
518 return cli_readline_into_buffer(prompt, console_buffer, 0);
519}
520
521
522int cli_readline_into_buffer(const char *const prompt, char *buffer,
523 int timeout)
524{
525 char *p = buffer;
526#ifdef CONFIG_CMDLINE_EDITING
527 unsigned int len = CONFIG_SYS_CBSIZE;
528 int rc;
529 static int initted;
530
531
532
533
534
535
536
537 if (gd->flags & GD_FLG_RELOC) {
538 if (!initted) {
539 hist_init();
540 initted = 1;
541 }
542
543 if (prompt)
544 puts(prompt);
545
546 rc = cread_line(prompt, p, &len, timeout);
547 return rc < 0 ? rc : len;
548
549 } else {
550#endif
551 char *p_buf = p;
552 int n = 0;
553 int plen = 0;
554 int col;
555 char c;
556
557
558 if (prompt) {
559 plen = strlen(prompt);
560 puts(prompt);
561 }
562 col = plen;
563
564 for (;;) {
565 if (bootretry_tstc_timeout())
566 return -2;
567 WATCHDOG_RESET();
568
569#ifdef CONFIG_SHOW_ACTIVITY
570 while (!tstc()) {
571 show_activity(0);
572 WATCHDOG_RESET();
573 }
574#endif
575 c = getc();
576
577
578
579
580 switch (c) {
581 case '\r':
582 case '\n':
583 *p = '\0';
584 puts("\r\n");
585 return p - p_buf;
586
587 case '\0':
588 continue;
589
590 case 0x03:
591 p_buf[0] = '\0';
592 return -1;
593
594 case 0x15:
595 while (col > plen) {
596 puts(erase_seq);
597 --col;
598 }
599 p = p_buf;
600 n = 0;
601 continue;
602
603 case 0x17:
604 p = delete_char(p_buf, p, &col, &n, plen);
605 while ((n > 0) && (*p != ' '))
606 p = delete_char(p_buf, p, &col, &n, plen);
607 continue;
608
609 case 0x08:
610 case 0x7F:
611 p = delete_char(p_buf, p, &col, &n, plen);
612 continue;
613
614 default:
615
616
617
618 if (n < CONFIG_SYS_CBSIZE-2) {
619 if (c == '\t') {
620#ifdef CONFIG_AUTO_COMPLETE
621
622
623
624
625 *p = '\0';
626 if (cmd_auto_complete(prompt,
627 console_buffer,
628 &n, &col)) {
629 p = p_buf + n;
630 continue;
631 }
632#endif
633 puts(tab_seq + (col & 07));
634 col += 8 - (col & 07);
635 } else {
636 char __maybe_unused buf[2];
637
638
639
640
641
642 ++col;
643 buf[0] = c;
644 buf[1] = '\0';
645 puts(buf);
646 }
647 *p++ = c;
648 ++n;
649 } else {
650 putc('\a');
651 }
652 }
653 }
654#ifdef CONFIG_CMDLINE_EDITING
655 }
656#endif
657}
658