[z180-stamp.git] / avr / cli_readline.c

/*
 * (C) Copyright 2014-2016 Leo C. <erbl259-lmu@yahoo.de>
 *
 * (C) Copyright 2000
 * Wolfgang Denk, DENX Software Engineering, wd@denx.de.
 *
 * Add to readline cmdline-editing by
 * (C) Copyright 2005
 * JinHua Luo, GuangDong Linux Center, <luo.jinhua@gd-linux.com>
 *
 * SPDX-License-Identifier:	GPL-2.0
 */

#include "cli_readline.h"
#include "common.h"
#include <string.h>
#include <stdio.h>
#include <stdlib.h>
#include <stdbool.h>
#include <ctype.h>

#include "config.h"
#include "con-utils.h"
#include "print-utils.h"
#include "command.h"


char console_buffer[CONFIG_SYS_CBSIZE + 1];	/* console I/O buffer	*/

#define CTL_CH(c)			((c) - 'a' + 1)
#define CTL_BACKSPACE		('\b')
#define DEL					((char)255)
#define DEL7				((char)127)


/************************************************************************************************/
/* TODO:
 *
 */

#define ESC						0x1b

#define KEY_TAB                 '\t'                                                // TAB key
#define KEY_CR                  '\r'                                                // RETURN key
#define KEY_BACKSPACE           '\b'                                                // Backspace key
#define KEY_ESCAPE              0x1B                                                // ESCAPE (pressed twice)

#define KEY_DOWN                0x80                                                // Down arrow key
#define KEY_UP                  0x81                                                // Up arrow key
#define KEY_LEFT                0x82                                                // Left arrow key
#define KEY_RIGHT               0x83                                                // Right arrow key
#define KEY_HOME                0x84                                                // Home key
#define KEY_DC                  0x85                                                // Delete character key
#define KEY_IC                  0x86                                                // Ins char/toggle ins mode key
#define KEY_NPAGE               0x87                                                // Next-page key
#define KEY_PPAGE               0x88                                                // Previous-page key
#define KEY_END                 0x89                                                // End key
#define KEY_BTAB                0x8A                                                // Back tab key
#define KEY_F1                  0x8B                                                // Function key F1
#define KEY_F(n)                (KEY_F1+(n)-1)                                      // Space for additional 12 function keys


struct fkey_tbl_s {
	const FLASH char *sequence;		/* ESC Sequence	*/
	int	code;						/* Keycode	*/
};

//typedef const FLASH struct fkey_tbl_s fkey_tbl_t;

#define FKEY_TBL_ITEM(_seq, _code)		{ FSTR(#_seq), _code }


static const FLASH struct fkey_tbl_s fkey_table[] = {

FKEY_TBL_ITEM(B,   KEY_DOWN),			// Down arrow key
FKEY_TBL_ITEM(A,   KEY_UP),				// Up arrow key
FKEY_TBL_ITEM(D,   KEY_LEFT),			// Left arrow key
FKEY_TBL_ITEM(C,   KEY_RIGHT),			// Right arrow key
FKEY_TBL_ITEM(1~,  KEY_HOME),			// Home key
FKEY_TBL_ITEM(3~,  KEY_DC),				// Delete character key
FKEY_TBL_ITEM(2~,  KEY_IC),				// Ins char/toggle ins mode key
FKEY_TBL_ITEM(6~,  KEY_NPAGE),			// Next-page key
FKEY_TBL_ITEM(5~,  KEY_PPAGE),			// Previous-page key
FKEY_TBL_ITEM(4~,  KEY_END),			// End key
FKEY_TBL_ITEM(Z,   KEY_BTAB),			// Back tab key
/* VT400: */
FKEY_TBL_ITEM(11~, KEY_F(1)),			// Function key F1
FKEY_TBL_ITEM(12~, KEY_F(2)),			// Function key F2
FKEY_TBL_ITEM(13~, KEY_F(3)),			// Function key F3
FKEY_TBL_ITEM(14~, KEY_F(4)),			// Function key F4
FKEY_TBL_ITEM(15~, KEY_F(5)),			// Function key F5
/* Linux consoe */
FKEY_TBL_ITEM([A,  KEY_F(1)),			// Function key F1
FKEY_TBL_ITEM([B,  KEY_F(2)),			// Function key F2
FKEY_TBL_ITEM([C,  KEY_F(3)),			// Function key F3
FKEY_TBL_ITEM([D,  KEY_F(4)),			// Function key F4
FKEY_TBL_ITEM([E,  KEY_F(5)),			// Function key F5

FKEY_TBL_ITEM(17~, KEY_F(6)),			// Function key F6
FKEY_TBL_ITEM(18~, KEY_F(7)),			// Function key F7
FKEY_TBL_ITEM(19~, KEY_F(8)),			// Function key F8
FKEY_TBL_ITEM(20~, KEY_F(9)),			// Function key F9
FKEY_TBL_ITEM(21~, KEY_F(10)),			// Function key F10
FKEY_TBL_ITEM(23~, KEY_F(11)),			// Function key F11
FKEY_TBL_ITEM(24~, KEY_F(12)),			// Function key F12
{ NULL }	/* Mark end of table */
};


typedef enum {
	STATE_GROUND,
	STATE_ESCAPE,
	STATE_CSI_ENTRY,
	STATE_SS3
} vtparse_state_t;

#define CHB_SIZE 	15

static
int vt_parse (void)
{
	static vtparse_state_t state = STATE_GROUND;
	char	buf[CHB_SIZE+1];
	uint8_t param[2];
	uint8_t i_buf;
	uint8_t i_param;
	int  ch;


	while (1) {
		ch = my_getchar(1);
//		debug_getch(state, ch);

		switch (state) {
		case STATE_GROUND:
			if (ch == ESC) {
				state = STATE_ESCAPE;
				continue;
			}
			if (ch == 0x7F)				// BACKSPACE on VT200 sends DEL char
				ch = KEY_BACKSPACE;		// map it to '\b'
			break;
		case STATE_ESCAPE:
			if (ch < 0)
				continue;

			if (ch == '[') {
				state = STATE_CSI_ENTRY;
				param[0] = param[1] = 0;
				i_buf = 0;
				i_param = 0;
				continue;
			}
			if (ch == 'O') {
				state = STATE_SS3;
				continue;
			}
			state = STATE_GROUND;
			break;
		case STATE_SS3:
			if (ch == 'F')				/* weird */
				ch = KEY_END;
			state = STATE_GROUND;
			break;
		case STATE_CSI_ENTRY:
			if (ch < 0)
				continue;

			buf[i_buf] = ch;
			if (i_buf < CHB_SIZE)
				i_buf++;
			if (ch == ';') {
				i_param++;
				continue;
			}
			if (isdigit(ch)) {
				if (i_param < 2)
					param[i_param] = param[i_param] * 10 + ch - '0';
				continue;
			}
			if (ch >= '@' && ch <= '~' && ch != '[') {
				buf[i_buf] = '\0';
				int_fast8_t i = 0;
				while (fkey_table[i].sequence) {
					if (! strcmp_P (buf, fkey_table[i].sequence)) {
						ch = fkey_table[i].code;
						break;
					}
					i++;
				}
				if (fkey_table[i].sequence == NULL) {
					ch = '$'; /* KEY_ESCAPE; */
				}
			}
			state = STATE_GROUND;
			break;
		}
		break; /* while */
	}

	return ch;
}

/************************************************************************************************/

/*
 * cmdline-editing related codes from vivi.
 * Author: Janghoon Lyu <nandy@mizi.com>
 */


struct hist_node_s {
	struct hist_node_s *next;
	char line[];
};
typedef struct hist_node_s hist_node;


static hist_node *hist_head;
static hist_node *hist_cur;

static void hist_reset(void)
{
	hist_cur = hist_head;
}

static hist_node *hist_search_node(char *line)
{
	hist_node *p = hist_head;

	while (p && strcmp(p->line, line))
		p = p->next;
	return p;
}

#if 0
static hist_node *hist_insert(char *line)
{
	hist_node *p = (hist_node *) malloc(sizeof (hist_node) + strlen(line) + 1);

	if (p) {
		strcpy(p->line, line);
		p->next = hist_head;
		hist_head = p;
	}
	return p;
}
#endif

static hist_node *hist_new(char *line)
{
	hist_node *p = (hist_node *) malloc(sizeof (hist_node) + strlen(line) + 1);

	if (p) {
		strcpy(p->line, line);
		p->next = NULL;
	}
	return p;
}

static hist_node *hist_delete(void)
{
	hist_node *p = NULL;
	hist_node *q = hist_head;

	if (q) {
		while(q->next) {
			p = q;
			q = q->next;
		}
		free(q);
		if (p)
			p->next = NULL;
	}
	return p;
}

static hist_node *hist_unlink(hist_node *pos)
{
	hist_node *p = NULL;
	hist_node *q = hist_head;

	while(q && q != pos) {
		p = q;
		q = q->next;
	}
	if (q) {
		if (p)
			p->next = q->next;
		else
			hist_head = q->next;
		q->next = NULL;
	}
	return q;
}

static uint_fast8_t hist_count(void)
{
	hist_node *p = hist_head;
	uint_fast8_t n = 0;

	while (p) {
		++n;
		p = p->next;
	}
	return n;
}

static hist_node *cread_add_to_hist(char *line)
{
	hist_node * p;

	p = hist_search_node(line);
	if (p)
		hist_unlink(p);
	else
		p = hist_new(line);

	if (p) {
		p->next = hist_head;
		hist_head = p;
	}

	if (hist_count() > CONFIG_SYS_HIST_MAX)
		hist_delete();
	return p;
}

static char *hist_prev(void)
{
	hist_node *p = hist_cur;

	if (p == NULL)
		return NULL;
	hist_cur = p->next;

	return  p->line;
}

static char *hist_next(void)
{
	hist_node *p = NULL;
	hist_node *q = hist_head;

	if(q == hist_cur)
		return NULL;

	while(q->next != hist_cur) {
		p = q;
		q = q->next;
	}
	hist_cur = q;

	return p ? p->line : "";
}

static char *hist_search_backward(char* buf, uint8_t num)
{
	hist_node *p = hist_cur;

	if (p == NULL)
		return NULL;

	while (p->next && strncmp(p->line, buf, num))
		p = p->next;

	if(!strncmp(p->line, buf, num)) {
		hist_cur = p->next;
		return  p->line;
	}
	return NULL;
}

static char *hist_search_forward (char* buf, uint8_t num)
{
	hist_node *p = NULL;
	hist_node *match = NULL;
	hist_node *q = hist_head;

	if(q == hist_cur)
		return NULL;

	while(q->next != hist_cur) {
		p = q;
		q = q->next;
		if (p && !strncmp(p->line, buf, num))
			match = p;
	}

	if(match) {
		hist_cur = match->next;
		return  match->line;
	}
	return NULL;
}

static void putnstr(char *str, int n)
{
	/* printf_P(PSTR("%.*s"), (int)n, str) */
	while (n-- && *str)
		putchar(*str++);
}

static void getcmd_putch(int ch) { putchar(ch);}
static int  getcmd_getch(void) { return vt_parse();}
static void getcmd_cbeep(void) { getcmd_putch('\a');}

static void beginning_of_line(uint8_t *num)
{
	while (*num) {
		getcmd_putch(CTL_BACKSPACE);
		(*num)--;
	}
}

static void erase_to_eol(uint_fast8_t *num, uint_fast8_t *eol_num)
{
	if (*num < *eol_num) {
		/* printf_P(PSTR("%*S"), (int)(*eol_num - *num), PSTR("")); */
		print_blanks(*eol_num - *num);
		do {
			getcmd_putch(CTL_BACKSPACE);
		} while (--(*eol_num) > *num);
	}
}

static void refresh_to_eol(char *buf, uint_fast8_t *num, uint_fast8_t *eol_num)
{
	if (*num < *eol_num) {
		uint_fast8_t wlen = *eol_num - *num;
		putnstr(buf + *num, wlen);
		*num = *eol_num;
	}
}

static void cread_add_char(char ichar, bool insert, uint_fast8_t *num,
	       uint_fast8_t *eol_num, char *buf, uint_fast8_t len)
{
	uint_fast8_t wlen;

	/* room ??? */
	if (insert || *num == *eol_num) {
		if (*eol_num > len - 1) {
			getcmd_cbeep();
			return;
		}
		(*eol_num)++;
	}

	if (insert) {
		wlen = *eol_num - *num;
		if (wlen > 1)
			memmove(&buf[*num+1], &buf[*num], wlen-1);

		buf[*num] = ichar;
		putnstr(buf + *num, wlen);
		(*num)++;
		while (--wlen)
			getcmd_putch(CTL_BACKSPACE);
	} else {
		/* echo the character */
		buf[*num] = ichar;
		putnstr(buf + *num, 1);
		(*num)++;
	}
}

static void cread_add_str(char *str, bool insert, uint_fast8_t *num,
				uint_fast8_t *eol_num, char *buf, uint_fast8_t len)
{
	char c;

	while ((c = *str++) != '\0')
		cread_add_char(c, insert, num, eol_num, buf, len);
}

static int cread_line(const FLASH char *const prompt, char *buf,
			uint_fast8_t len, bool enable_history)
{
	uint_fast8_t num = 0;
	uint_fast8_t eol_num = 0;
	bool insert = 1;

	(void) prompt;

	if (buf[0])
		cread_add_str(buf, 1, &num, &eol_num, buf, len);

	hist_reset();

	while (1) {
		int ichar = getcmd_getch();

		if ((ichar == '\n') || (ichar == '\r')) {
			putchar('\n');
			break;
		}


		switch (ichar) {

		case KEY_HOME:
		case CTL_CH('a'):
			beginning_of_line(&num);
			break;
		case CTL_CH('c'):			/* ^C - break */
			putchar('\n');
			*buf = '\0';			/* discard input */
			return -1;
		case KEY_RIGHT:
		case CTL_CH('f'):			/* forward-char */
			if (num < eol_num) {
				getcmd_putch(buf[num]);
				num++;
			}
			break;
		case KEY_LEFT:
		case CTL_CH('b'):			/* backward-char */
			if (num) {
				getcmd_putch(CTL_BACKSPACE);
				num--;
			}
			break;
		case KEY_DC:
		case CTL_CH('d'):			/* delete-char */
			if (num < eol_num) {
				uint_fast8_t wlen = eol_num - num - 1;
				if (wlen) {
					memmove(&buf[num], &buf[num+1], wlen);
					putnstr(buf + num, wlen);
				}

				getcmd_putch(' ');
				do {
					getcmd_putch(CTL_BACKSPACE);
				} while (wlen--);
				eol_num--;
			}
			break;
		case CTL_CH('k'):			/* kill-line */
			erase_to_eol(&num, &eol_num);
			break;
		case KEY_END:
		case CTL_CH('e'):
			refresh_to_eol(buf, &num, &eol_num);
			break;
		case KEY_IC:
		case CTL_CH('o'):
			insert = !insert;
			break;
		case CTL_CH('x'):
		case CTL_CH('u'):			/* kill-whole-line */
			beginning_of_line(&num);
			erase_to_eol(&num, &eol_num);
			break;
		case DEL:
		case DEL7:
		case 8:						/* backward-delete-char */
			if (num) {
				uint_fast8_t wlen = eol_num - --num;
				buf[eol_num] = ' ';
				memmove(&buf[num], &buf[num+1], wlen);
				getcmd_putch(CTL_BACKSPACE);
				putnstr(buf + num, wlen);
				do {
					getcmd_putch(CTL_BACKSPACE);
				} while (--wlen);
				eol_num--;
			}
			break;
		case KEY_UP:
		case CTL_CH('p'):			/* previous-history */
		case KEY_DOWN:
		case CTL_CH('n'):			/* next-history */
			if (enable_history) {
				char *hline;

				if (ichar == CTL_CH('p') || ichar == KEY_UP)
					hline = hist_prev();
				else
					hline = hist_next();

				if (hline) {
					/* first, go home */
					beginning_of_line(&num);
					/* overwrite current line */
					cread_add_str(hline, 0, &num, &eol_num, buf, len);
					/* erase to end of line */
					erase_to_eol(&num, &eol_num);

				} else {
					getcmd_cbeep();
				}
			} else {
				getcmd_cbeep();
			}
			break;
		case KEY_PPAGE:			/* history-search-backward */
		case KEY_NPAGE:			/* history-search-forward */
			if (enable_history) {
				char *hline;
				if (ichar == KEY_PPAGE)
					hline = hist_search_backward(buf, num);
				else
					hline = hist_search_forward(buf, num);

				if (hline) {
					uint_fast8_t num2 = num;
					/* overwrite current line from cursor position */
					cread_add_str(hline+num, 0, &num2, &eol_num, buf, len);
					/* erase to end of line */
					erase_to_eol(&num2, &eol_num);
					/* cursor back */
					while (num2-- > num)
						getcmd_putch(CTL_BACKSPACE);
				} else {
					getcmd_cbeep();
				}
			} else {
				getcmd_cbeep();
			}
			break;
#ifdef CONFIG_AUTO_COMPLETE
		case '\t': {
			int num2, col;

			/* do not autocomplete when in the middle */
			if (num < eol_num) {
				getcmd_cbeep();
				break;
			}

			buf[num] = '\0';
			col = strlen_P(prompt) + eol_num;
			num2 = num;
			if (cmd_auto_complete(prompt, buf, &num2, &col)) {
				col = num2 - num;
				num += col;
				eol_num += col;
			}
			break;
		}
#endif
		default:
			if (isprint(ichar))
				cread_add_char(ichar, insert, &num, &eol_num, buf, len);
			break;
		}
	}
	while (eol_num && buf[eol_num-1] == ' ')
		--eol_num;			/* remove trailing blanks */
	buf[eol_num] = '\0';	/* lose the newline */

	if (enable_history && buf[0])
		cread_add_to_hist(buf);
	return eol_num;
}

/****************************************************************************/

int cli_readline(const FLASH char *const prompt, bool enable_history)
{
	/*
	 * If console_buffer isn't 0-length the user will be prompted to modify
	 * it instead of entering it from scratch as desired.
	 */
	console_buffer[0] = '\0';

	if (prompt)
		my_puts_P(prompt);

	return cread_line(prompt, console_buffer, CONFIG_SYS_CBSIZE, enable_history);
}
Commit	Line	Data
d684c216	1	/*
04b3ea0e	2	* (C) Copyright 2014-2016 Leo C. <erbl259-lmu@yahoo.de>
35edb766	3	*
d684c216 L	4	* (C) Copyright 2000
	5	* Wolfgang Denk, DENX Software Engineering, wd@denx.de.
	6	*
	7	* Add to readline cmdline-editing by
	8	* (C) Copyright 2005
	9	* JinHua Luo, GuangDong Linux Center, <luo.jinhua@gd-linux.com>
	10	*
f32690e8	11	* SPDX-License-Identifier: GPL-2.0
d684c216 L	12	*/
d684c216 L	13
8ed66016	14	#include "cli_readline.h"
d684c216	15	#include "common.h"
d684c216 L	16	#include <string.h>
d684c216 L	17	#include <stdio.h>
a8b4c964 L	18	#include <stdlib.h>
a8b4c964 L	19	#include <stdbool.h>
8506d791	20	#include <ctype.h>
d684c216 L	21
	22	#include "config.h"
	23	#include "con-utils.h"
8591c65b	24	#include "print-utils.h"
d684c216	25	#include "command.h"
d684c216	26
8506d791 L	27
8506d791 L	28
e347ae07 L	29	char console_buffer[CONFIG_SYS_CBSIZE + 1]; /* console I/O buffer */
	30
	31	#define CTL_CH(c) ((c) - 'a' + 1)
	32	#define CTL_BACKSPACE ('\b')
	33	#define DEL ((char)255)
	34	#define DEL7 ((char)127)
	35
	36
8506d791 L	37	/************************************************************************************************/
	38	/* TODO:
	39	*
	40	*/
	41
	42	#define ESC 0x1b
	43
	44	#define KEY_TAB '\t' // TAB key
	45	#define KEY_CR '\r' // RETURN key
	46	#define KEY_BACKSPACE '\b' // Backspace key
	47	#define KEY_ESCAPE 0x1B // ESCAPE (pressed twice)
	48
	49	#define KEY_DOWN 0x80 // Down arrow key
	50	#define KEY_UP 0x81 // Up arrow key
	51	#define KEY_LEFT 0x82 // Left arrow key
	52	#define KEY_RIGHT 0x83 // Right arrow key
	53	#define KEY_HOME 0x84 // Home key
	54	#define KEY_DC 0x85 // Delete character key
	55	#define KEY_IC 0x86 // Ins char/toggle ins mode key
	56	#define KEY_NPAGE 0x87 // Next-page key
	57	#define KEY_PPAGE 0x88 // Previous-page key
	58	#define KEY_END 0x89 // End key
	59	#define KEY_BTAB 0x8A // Back tab key
	60	#define KEY_F1 0x8B // Function key F1
	61	#define KEY_F(n) (KEY_F1+(n)-1) // Space for additional 12 function keys
	62
	63
	64	struct fkey_tbl_s {
	65	const FLASH char sequence; / ESC Sequence */
	66	int code; /* Keycode */
	67	};
	68
	69	//typedef const FLASH struct fkey_tbl_s fkey_tbl_t;
	70
	71	#define FKEY_TBL_ITEM(_seq, _code) { FSTR(#_seq), _code }
	72
	73
	74
	75	static const FLASH struct fkey_tbl_s fkey_table[] = {
	76
	77	FKEY_TBL_ITEM(B, KEY_DOWN), // Down arrow key
ef77033c	78	FKEY_TBL_ITEM(A, KEY_UP), // Up arrow key
8506d791	79	FKEY_TBL_ITEM(D, KEY_LEFT), // Left arrow key
ef77033c	80	FKEY_TBL_ITEM(C, KEY_RIGHT), // Right arrow key
8506d791	81	FKEY_TBL_ITEM(1~, KEY_HOME), // Home key
ef77033c L	82	FKEY_TBL_ITEM(3~, KEY_DC), // Delete character key
	83	FKEY_TBL_ITEM(2~, KEY_IC), // Ins char/toggle ins mode key
	84	FKEY_TBL_ITEM(6~, KEY_NPAGE), // Next-page key
	85	FKEY_TBL_ITEM(5~, KEY_PPAGE), // Previous-page key
8506d791 L	86	FKEY_TBL_ITEM(4~, KEY_END), // End key
	87	FKEY_TBL_ITEM(Z, KEY_BTAB), // Back tab key
	88	/* VT400: */
	89	FKEY_TBL_ITEM(11~, KEY_F(1)), // Function key F1
	90	FKEY_TBL_ITEM(12~, KEY_F(2)), // Function key F2
	91	FKEY_TBL_ITEM(13~, KEY_F(3)), // Function key F3
	92	FKEY_TBL_ITEM(14~, KEY_F(4)), // Function key F4
	93	FKEY_TBL_ITEM(15~, KEY_F(5)), // Function key F5
	94	/* Linux consoe */
	95	FKEY_TBL_ITEM([A, KEY_F(1)), // Function key F1
	96	FKEY_TBL_ITEM([B, KEY_F(2)), // Function key F2
	97	FKEY_TBL_ITEM([C, KEY_F(3)), // Function key F3
	98	FKEY_TBL_ITEM([D, KEY_F(4)), // Function key F4
	99	FKEY_TBL_ITEM([E, KEY_F(5)), // Function key F5
	100
	101	FKEY_TBL_ITEM(17~, KEY_F(6)), // Function key F6
	102	FKEY_TBL_ITEM(18~, KEY_F(7)), // Function key F7
	103	FKEY_TBL_ITEM(19~, KEY_F(8)), // Function key F8
	104	FKEY_TBL_ITEM(20~, KEY_F(9)), // Function key F9
ef77033c L	105	FKEY_TBL_ITEM(21~, KEY_F(10)), // Function key F10
	106	FKEY_TBL_ITEM(23~, KEY_F(11)), // Function key F11
	107	FKEY_TBL_ITEM(24~, KEY_F(12)), // Function key F12
8506d791 L	108	{ NULL } /* Mark end of table */
	109	};
	110
	111
	112
	113	typedef enum {
	114	STATE_GROUND,
	115	STATE_ESCAPE,
f6edf92b L	116	STATE_CSI_ENTRY,
f6edf92b L	117	STATE_SS3
8506d791 L	118	} vtparse_state_t;
	119
	120	#define CHB_SIZE 15
	121
	122	static
	123	int vt_parse (void)
	124	{
	125	static vtparse_state_t state = STATE_GROUND;
	126	char buf[CHB_SIZE+1];
	127	uint8_t param[2];
	128	uint8_t i_buf;
	129	uint8_t i_param;
	130	int ch;
	131
	132
	133	while (1) {
	134	ch = my_getchar(1);
	135	// debug_getch(state, ch);
	136
	137	switch (state) {
	138	case STATE_GROUND:
	139	if (ch == ESC) {
	140	state = STATE_ESCAPE;
	141	continue;
	142	}
	143	if (ch == 0x7F) // BACKSPACE on VT200 sends DEL char
	144	ch = KEY_BACKSPACE; // map it to '\b'
	145	break;
	146	case STATE_ESCAPE:
	147	if (ch < 0)
	148	continue;
	149
	150	if (ch == '[') {
	151	state = STATE_CSI_ENTRY;
	152	param[0] = param[1] = 0;
	153	i_buf = 0;
	154	i_param = 0;
	155	continue;
	156	}
f6edf92b L	157	if (ch == 'O') {
	158	state = STATE_SS3;
	159	continue;
	160	}
	161	state = STATE_GROUND;
	162	break;
	163	case STATE_SS3:
	164	if (ch == 'F') /* weird */
	165	ch = KEY_END;
8506d791 L	166	state = STATE_GROUND;
	167	break;
	168	case STATE_CSI_ENTRY:
	169	if (ch < 0)
	170	continue;
	171
	172	buf[i_buf] = ch;
	173	if (i_buf < CHB_SIZE)
	174	i_buf++;
	175	if (ch == ';') {
	176	i_param++;
	177	continue;
	178	}
	179	if (isdigit(ch)) {
	180	if (i_param < 2)
	181	param[i_param] = param[i_param] * 10 + ch - '0';
	182	continue;
	183	}
	184	if (ch >= '@' && ch <= '~' && ch != '[') {
	185	buf[i_buf] = '\0';
	186	int_fast8_t i = 0;
	187	while (fkey_table[i].sequence) {
	188	if (! strcmp_P (buf, fkey_table[i].sequence)) {
	189	ch = fkey_table[i].code;
	190	break;
	191	}
	192	i++;
	193	}
	194	if (fkey_table[i].sequence == NULL) {
	195	ch = '$'; /* KEY_ESCAPE; */
	196	}
	197	}
	198	state = STATE_GROUND;
	199	break;
	200	}
	201	break; /* while */
	202	}
	203
	204	return ch;
	205	}
	206
	207	/************************************************************************************************/
	208
d684c216 L	209	/*
	210	* cmdline-editing related codes from vivi.
	211	* Author: Janghoon Lyu <nandy@mizi.com>
	212	*/
	213
d684c216	214
db6a28d8 L	215	struct hist_node_s {
	216	struct hist_node_s *next;
	217	char line[];
	218	};
	219	typedef struct hist_node_s hist_node;
	220
d684c216	221
db6a28d8 L	222	static hist_node *hist_head;
db6a28d8 L	223	static hist_node *hist_cur;
d684c216	224
e347ae07 L	225	static void hist_reset(void)
	226	{
	227	hist_cur = hist_head;
	228	}
	229
db6a28d8	230	static hist_node hist_search_node(char line)
d684c216	231	{
db6a28d8	232	hist_node *p = hist_head;
d684c216	233
db6a28d8 L	234	while (p && strcmp(p->line, line))
	235	p = p->next;
	236	return p;
	237	}
	238
	239	#if 0
	240	static hist_node hist_insert(char line)
	241	{
	242	hist_node p = (hist_node ) malloc(sizeof (hist_node) + strlen(line) + 1);
	243
	244	if (p) {
	245	strcpy(p->line, line);
	246	p->next = hist_head;
	247	hist_head = p;
a8b4c964	248	}
db6a28d8 L	249	return p;
	250	}
	251	#endif
	252
	253	static hist_node hist_new(char line)
	254	{
	255	hist_node p = (hist_node ) malloc(sizeof (hist_node) + strlen(line) + 1);
d684c216	256
a8b4c964	257	if (p) {
db6a28d8 L	258	strcpy(p->line, line);
	259	p->next = NULL;
	260	}
	261	return p;
	262	}
d684c216	263
db6a28d8 L	264	static hist_node *hist_delete(void)
	265	{
	266	hist_node *p = NULL;
	267	hist_node *q = hist_head;
a8b4c964	268
db6a28d8 L	269	if (q) {
	270	while(q->next) {
	271	p = q;
	272	q = q->next;
	273	}
	274	free(q);
	275	if (p)
	276	p->next = NULL;
a8b4c964	277	}
db6a28d8	278	return p;
d684c216 L	279	}
d684c216 L	280
db6a28d8	281	static hist_node hist_unlink(hist_node pos)
d684c216	282	{
db6a28d8 L	283	hist_node *p = NULL;
db6a28d8 L	284	hist_node *q = hist_head;
d684c216	285
db6a28d8 L	286	while(q && q != pos) {
	287	p = q;
	288	q = q->next;
	289	}
	290	if (q) {
	291	if (p)
	292	p->next = q->next;
	293	else
	294	hist_head = q->next;
	295	q->next = NULL;
	296	}
	297	return q;
	298	}
d684c216	299
db6a28d8 L	300	static uint_fast8_t hist_count(void)
	301	{
	302	hist_node *p = hist_head;
	303	uint_fast8_t n = 0;
d684c216	304
db6a28d8 L	305	while (p) {
	306	++n;
	307	p = p->next;
d684c216	308	}
db6a28d8 L	309	return n;
db6a28d8 L	310	}
d684c216	311
db6a28d8 L	312	static hist_node cread_add_to_hist(char line)
	313	{
	314	hist_node * p;
	315
	316	p = hist_search_node(line);
	317	if (p)
	318	hist_unlink(p);
	319	else
	320	p = hist_new(line);
	321
	322	if (p) {
	323	p->next = hist_head;
	324	hist_head = p;
	325	}
	326
	327	if (hist_count() > CONFIG_SYS_HIST_MAX)
	328	hist_delete();
	329	return p;
d684c216 L	330	}
d684c216 L	331
db6a28d8	332	static char *hist_prev(void)
d684c216	333	{
db6a28d8	334	hist_node *p = hist_cur;
d684c216	335
db6a28d8	336	if (p == NULL)
d684c216	337	return NULL;
e347ae07	338	hist_cur = p->next;
d684c216	339
db6a28d8 L	340	return p->line;
db6a28d8 L	341	}
d684c216	342
db6a28d8 L	343	static char *hist_next(void)
	344	{
	345	hist_node *p = NULL;
	346	hist_node *q = hist_head;
	347
	348	if(q == hist_cur)
	349	return NULL;
	350
	351	while(q->next != hist_cur) {
	352	p = q;
	353	q = q->next;
	354	}
	355	hist_cur = q;
d684c216	356
db6a28d8	357	return p ? p->line : "";
d684c216 L	358	}
d684c216 L	359
e347ae07 L	360	static char hist_search_backward(char buf, uint8_t num)
	361	{
	362	hist_node *p = hist_cur;
	363
	364	if (p == NULL)
	365	return NULL;
	366
	367	while (p->next && strncmp(p->line, buf, num))
	368	p = p->next;
d684c216	369
e347ae07 L	370	if(!strncmp(p->line, buf, num)) {
	371	hist_cur = p->next;
	372	return p->line;
	373	}
	374	return NULL;
d684c216 L	375	}
d684c216 L	376
e347ae07 L	377	static char hist_search_forward (char buf, uint8_t num)
	378	{
	379	hist_node *p = NULL;
	380	hist_node *match = NULL;
	381	hist_node *q = hist_head;
	382
	383	if(q == hist_cur)
	384	return NULL;
	385
	386	while(q->next != hist_cur) {
	387	p = q;
	388	q = q->next;
	389	if (p && !strncmp(p->line, buf, num))
	390	match = p;
	391	}
	392
	393	if(match) {
	394	hist_cur = match->next;
	395	return match->line;
	396	}
	397	return NULL;
d684c216 L	398	}
d684c216 L	399
e347ae07 L	400	static void putnstr(char *str, int n)
	401	{
	402	/* printf_P(PSTR("%.s"), (int)n, str) /
	403	while (n-- && *str)
	404	putchar(*str++);
	405	}
	406
	407	static void getcmd_putch(int ch) { putchar(ch);}
	408	static int getcmd_getch(void) { return vt_parse();}
	409	static void getcmd_cbeep(void) { getcmd_putch('\a');}
	410
	411	static void beginning_of_line(uint8_t *num)
	412	{
	413	while (*num) {
	414	getcmd_putch(CTL_BACKSPACE);
	415	(*num)--;
	416	}
	417	}
	418
	419	static void erase_to_eol(uint_fast8_t num, uint_fast8_t eol_num)
	420	{
	421	if (num < eol_num) {
	422	/* printf_P(PSTR("%S"), (int)(eol_num - num), PSTR("")); /
	423	print_blanks(eol_num - num);
	424	do {
	425	getcmd_putch(CTL_BACKSPACE);
	426	} while (--(eol_num) > num);
	427	}
	428	}
	429
	430	static void refresh_to_eol(char buf, uint_fast8_t num, uint_fast8_t *eol_num)
	431	{
	432	if (num < eol_num) {
	433	uint_fast8_t wlen = eol_num - num;
	434	putnstr(buf + *num, wlen);
	435	num = eol_num;
	436	}
d684c216 L	437	}
d684c216 L	438
a8b4c964 L	439	static void cread_add_char(char ichar, bool insert, uint_fast8_t *num,
a8b4c964 L	440	uint_fast8_t eol_num, char buf, uint_fast8_t len)
d684c216	441	{
a8b4c964	442	uint_fast8_t wlen;
d684c216 L	443
	444	/* room ??? */
	445	if (insert \|\| num == eol_num) {
	446	if (*eol_num > len - 1) {
	447	getcmd_cbeep();
	448	return;
	449	}
	450	(*eol_num)++;
	451	}
	452
	453	if (insert) {
	454	wlen = eol_num - num;
	455	if (wlen > 1)
	456	memmove(&buf[num+1], &buf[num], wlen-1);
	457
	458	buf[*num] = ichar;
	459	putnstr(buf + *num, wlen);
	460	(*num)++;
	461	while (--wlen)
	462	getcmd_putch(CTL_BACKSPACE);
	463	} else {
	464	/* echo the character */
d684c216	465	buf[*num] = ichar;
4912667b	466	putnstr(buf + *num, 1);
d684c216 L	467	(*num)++;
	468	}
	469	}
	470
4912667b L	471	static void cread_add_str(char str, bool insert, uint_fast8_t num,
4912667b L	472	uint_fast8_t eol_num, char buf, uint_fast8_t len)
d684c216	473	{
4912667b L	474	char c;
	475
	476	while ((c = *str++) != '\0')
	477	cread_add_char(c, insert, num, eol_num, buf, len);
d684c216 L	478	}
d684c216 L	479
8ed66016	480	static int cread_line(const FLASH char const prompt, char buf,
4912667b	481	uint_fast8_t len, bool enable_history)
d684c216	482	{
a8b4c964 L	483	uint_fast8_t num = 0;
a8b4c964 L	484	uint_fast8_t eol_num = 0;
a8b4c964	485	bool insert = 1;
d684c216 L	486
	487	(void) prompt;
	488
4912667b L	489	if (buf[0])
4912667b L	490	cread_add_str(buf, 1, &num, &eol_num, buf, len);
d684c216	491
e347ae07 L	492	hist_reset();
e347ae07 L	493
d684c216	494	while (1) {
ef77033c	495	int ichar = getcmd_getch();
d684c216 L	496
	497	if ((ichar == '\n') \|\| (ichar == '\r')) {
	498	putchar('\n');
	499	break;
	500	}
	501
d684c216 L	502
d684c216 L	503	switch (ichar) {
d684c216	504
8506d791	505	case KEY_HOME:
d684c216	506	case CTL_CH('a'):
e347ae07	507	beginning_of_line(&num);
d684c216	508	break;
a8b4c964	509	case CTL_CH('c'): /* ^C - break */
4912667b	510	putchar('\n');
a8b4c964	511	buf = '\0'; / discard input */
d684c216	512	return -1;
8506d791	513	case KEY_RIGHT:
a8b4c964	514	case CTL_CH('f'): /* forward-char */
d684c216 L	515	if (num < eol_num) {
	516	getcmd_putch(buf[num]);
	517	num++;
	518	}
	519	break;
8506d791	520	case KEY_LEFT:
a8b4c964	521	case CTL_CH('b'): /* backward-char */
d684c216 L	522	if (num) {
	523	getcmd_putch(CTL_BACKSPACE);
	524	num--;
	525	}
	526	break;
8506d791	527	case KEY_DC:
a8b4c964	528	case CTL_CH('d'): /* delete-char */
d684c216	529	if (num < eol_num) {
ef77033c	530	uint_fast8_t wlen = eol_num - num - 1;
d684c216 L	531	if (wlen) {
	532	memmove(&buf[num], &buf[num+1], wlen);
	533	putnstr(buf + num, wlen);
	534	}
	535
	536	getcmd_putch(' ');
	537	do {
	538	getcmd_putch(CTL_BACKSPACE);
	539	} while (wlen--);
	540	eol_num--;
	541	}
	542	break;
a8b4c964	543	case CTL_CH('k'): /* kill-line */
e347ae07	544	erase_to_eol(&num, &eol_num);
d684c216	545	break;
ed7d7fd3	546	case KEY_END:
d684c216	547	case CTL_CH('e'):
e347ae07	548	refresh_to_eol(buf, &num, &eol_num);
d684c216	549	break;
8506d791	550	case KEY_IC:
d684c216 L	551	case CTL_CH('o'):
	552	insert = !insert;
	553	break;
	554	case CTL_CH('x'):
a8b4c964	555	case CTL_CH('u'): /* kill-whole-line */
e347ae07 L	556	beginning_of_line(&num);
e347ae07 L	557	erase_to_eol(&num, &eol_num);
d684c216 L	558	break;
	559	case DEL:
	560	case DEL7:
a8b4c964	561	case 8: /* backward-delete-char */
d684c216	562	if (num) {
4912667b L	563	uint_fast8_t wlen = eol_num - --num;
4912667b L	564	buf[eol_num] = ' ';
d684c216 L	565	memmove(&buf[num], &buf[num+1], wlen);
	566	getcmd_putch(CTL_BACKSPACE);
	567	putnstr(buf + num, wlen);
d684c216 L	568	do {
d684c216 L	569	getcmd_putch(CTL_BACKSPACE);
4912667b	570	} while (--wlen);
d684c216 L	571	eol_num--;
	572	}
	573	break;
8506d791	574	case KEY_UP:
a8b4c964	575	case CTL_CH('p'): /* previous-history */
8506d791	576	case KEY_DOWN:
a8b4c964	577	case CTL_CH('n'): /* next-history */
8ed66016 L	578	if (enable_history) {
	579	char *hline;
	580
	581	if (ichar == CTL_CH('p') \|\| ichar == KEY_UP)
	582	hline = hist_prev();
	583	else
	584	hline = hist_next();
	585
	586	if (hline) {
8ed66016	587	/* first, go home */
e347ae07	588	beginning_of_line(&num);
4912667b L	589	/* overwrite current line */
4912667b L	590	cread_add_str(hline, 0, &num, &eol_num, buf, len);
8ed66016	591	/* erase to end of line */
e347ae07	592	erase_to_eol(&num, &eol_num);
8ed66016	593
8ed66016 L	594	} else {
	595	getcmd_cbeep();
	596	}
	597	} else {
d684c216	598	getcmd_cbeep();
d684c216	599	}
8ed66016	600	break;
ef77033c L	601	case KEY_PPAGE: /* history-search-backward */
	602	case KEY_NPAGE: /* history-search-forward */
	603	if (enable_history) {
	604	char *hline;
ef77033c	605	if (ichar == KEY_PPAGE)
e347ae07	606	hline = hist_search_backward(buf, num);
ef77033c	607	else
e347ae07	608	hline = hist_search_forward(buf, num);
ef77033c L	609
ef77033c L	610	if (hline) {
4912667b L	611	uint_fast8_t num2 = num;
	612	/* overwrite current line from cursor position */
	613	cread_add_str(hline+num, 0, &num2, &eol_num, buf, len);
ef77033c	614	/* erase to end of line */
4912667b L	615	erase_to_eol(&num2, &eol_num);
	616	/* cursor back */
	617	while (num2-- > num)
e347ae07	618	getcmd_putch(CTL_BACKSPACE);
ef77033c L	619	} else {
	620	getcmd_cbeep();
	621	}
	622	} else {
	623	getcmd_cbeep();
	624	}
	625	break;
d684c216 L	626	#ifdef CONFIG_AUTO_COMPLETE
	627	case '\t': {
	628	int num2, col;
	629
	630	/* do not autocomplete when in the middle */
	631	if (num < eol_num) {
	632	getcmd_cbeep();
	633	break;
	634	}
	635
	636	buf[num] = '\0';
	637	col = strlen_P(prompt) + eol_num;
	638	num2 = num;
	639	if (cmd_auto_complete(prompt, buf, &num2, &col)) {
	640	col = num2 - num;
	641	num += col;
	642	eol_num += col;
	643	}
	644	break;
	645	}
	646	#endif
	647	default:
8506d791	648	if (isprint(ichar))
4912667b	649	cread_add_char(ichar, insert, &num, &eol_num, buf, len);
d684c216 L	650	break;
	651	}
	652	}
4912667b L	653	while (eol_num && buf[eol_num-1] == ' ')
4912667b L	654	--eol_num; /* remove trailing blanks */
d684c216 L	655	buf[eol_num] = '\0'; /* lose the newline */
d684c216 L	656
e347ae07 L	657	if (enable_history && buf[0])
e347ae07 L	658	cread_add_to_hist(buf);
4912667b	659	return eol_num;
d684c216 L	660	}
d684c216 L	661
d684c216 L	662	/****************************************************************************/
d684c216 L	663
8ed66016	664	int cli_readline(const FLASH char *const prompt, bool enable_history)
d684c216 L	665	{
	666	/*
	667	* If console_buffer isn't 0-length the user will be prompted to modify
	668	* it instead of entering it from scratch as desired.
	669	*/
	670	console_buffer[0] = '\0';
	671
4912667b L	672	if (prompt)
	673	my_puts_P(prompt);
	674
	675	return cread_line(prompt, console_buffer, CONFIG_SYS_CBSIZE, enable_history);
d684c216	676	}