Rewrote the telnet server to buffer the output in a single, large buffer rather than as individual lines. This both makes output faster and makes it possible to buffer more outgoing data.
This commit is contained in:
parent
10692296a1
commit
814558b1fe
1 changed files with 119 additions and 155 deletions
|
@ -28,7 +28,7 @@
|
||||||
*
|
*
|
||||||
* This file is part of the Contiki desktop OS.
|
* This file is part of the Contiki desktop OS.
|
||||||
*
|
*
|
||||||
* $Id: telnetd.c,v 1.9 2008/02/09 18:51:56 oliverschmidt Exp $
|
* $Id: telnetd.c,v 1.10 2008/02/24 20:43:28 adamdunkels Exp $
|
||||||
*
|
*
|
||||||
*/
|
*/
|
||||||
|
|
||||||
|
@ -44,10 +44,7 @@
|
||||||
#define ISO_nl 0x0a
|
#define ISO_nl 0x0a
|
||||||
#define ISO_cr 0x0d
|
#define ISO_cr 0x0d
|
||||||
|
|
||||||
#define XSIZE 36
|
PROCESS(telnetd_process, "Telnet server");
|
||||||
#define YSIZE 12
|
|
||||||
|
|
||||||
PROCESS(telnetd_process, "Shell server");
|
|
||||||
|
|
||||||
AUTOSTART_PROCESSES(&telnetd_process);
|
AUTOSTART_PROCESSES(&telnetd_process);
|
||||||
|
|
||||||
|
@ -58,16 +55,10 @@ AUTOSTART_PROCESSES(&telnetd_process);
|
||||||
#define TELNETD_CONF_NUMLINES 25
|
#define TELNETD_CONF_NUMLINES 25
|
||||||
#endif
|
#endif
|
||||||
|
|
||||||
struct telnetd_line {
|
|
||||||
char line[TELNETD_CONF_LINELEN + 1];
|
|
||||||
};
|
|
||||||
MEMB(linemem, struct telnetd_line, TELNETD_CONF_NUMLINES);
|
|
||||||
|
|
||||||
struct telnetd_state {
|
struct telnetd_state {
|
||||||
char *lines[TELNETD_CONF_NUMLINES];
|
|
||||||
char buf[TELNETD_CONF_LINELEN + 1];
|
char buf[TELNETD_CONF_LINELEN + 1];
|
||||||
char bufptr;
|
char bufptr;
|
||||||
u8_t numsent;
|
uint16_t numsent;
|
||||||
u8_t state;
|
u8_t state;
|
||||||
#define STATE_NORMAL 0
|
#define STATE_NORMAL 0
|
||||||
#define STATE_IAC 1
|
#define STATE_IAC 1
|
||||||
|
@ -85,25 +76,74 @@ static struct telnetd_state s;
|
||||||
#define TELNET_WONT 252
|
#define TELNET_WONT 252
|
||||||
#define TELNET_DO 253
|
#define TELNET_DO 253
|
||||||
#define TELNET_DONT 254
|
#define TELNET_DONT 254
|
||||||
/*-----------------------------------------------------------------------------------*/
|
|
||||||
static char *
|
#define DEBUG 0
|
||||||
alloc_line(void)
|
#if DEBUG
|
||||||
{
|
#include <stdio.h>
|
||||||
return memb_alloc(&linemem);
|
#define PRINTF(...) printf(__VA_ARGS__)
|
||||||
}
|
#else
|
||||||
/*-----------------------------------------------------------------------------------*/
|
#define PRINTF(...)
|
||||||
|
#endif
|
||||||
|
|
||||||
|
struct telnetd_buf {
|
||||||
|
char bufmem[TELNETD_CONF_NUMLINES * TELNETD_CONF_LINELEN];
|
||||||
|
int ptr;
|
||||||
|
int size;
|
||||||
|
};
|
||||||
|
|
||||||
|
static struct telnetd_buf buf;
|
||||||
|
|
||||||
|
#define MIN(a, b) ((a) < (b)? (a): (b))
|
||||||
|
/*---------------------------------------------------------------------------*/
|
||||||
static void
|
static void
|
||||||
dealloc_line(char *line)
|
buf_init(struct telnetd_buf *buf)
|
||||||
{
|
{
|
||||||
memb_free(&linemem, line);
|
buf->ptr = 0;
|
||||||
|
buf->size = TELNETD_CONF_NUMLINES * TELNETD_CONF_LINELEN;
|
||||||
}
|
}
|
||||||
/*-----------------------------------------------------------------------------------*/
|
/*---------------------------------------------------------------------------*/
|
||||||
|
static int
|
||||||
|
buf_append(struct telnetd_buf *buf, const char *data, int len)
|
||||||
|
{
|
||||||
|
int copylen;
|
||||||
|
|
||||||
|
PRINTF("buf_append len %d (%d) '%.*s'\n", len, buf->ptr, len, data);
|
||||||
|
copylen = MIN(len, buf->size - buf->ptr);
|
||||||
|
memcpy(&buf->bufmem[buf->ptr], data, copylen);
|
||||||
|
buf->ptr += copylen;
|
||||||
|
|
||||||
|
return copylen;
|
||||||
|
}
|
||||||
|
/*---------------------------------------------------------------------------*/
|
||||||
|
static void
|
||||||
|
buf_copyto(struct telnetd_buf *buf, char *to, int len)
|
||||||
|
{
|
||||||
|
memcpy(to, &buf->bufmem[0], len);
|
||||||
|
}
|
||||||
|
/*---------------------------------------------------------------------------*/
|
||||||
|
static void
|
||||||
|
buf_pop(struct telnetd_buf *buf, int len)
|
||||||
|
{
|
||||||
|
int poplen;
|
||||||
|
|
||||||
|
PRINTF("buf_pop len %d (%d)\n", len, buf->ptr);
|
||||||
|
poplen = MIN(len, buf->ptr);
|
||||||
|
memcpy(&buf->bufmem[0], &buf->bufmem[poplen], buf->ptr - poplen);
|
||||||
|
buf->ptr -= poplen;
|
||||||
|
}
|
||||||
|
/*---------------------------------------------------------------------------*/
|
||||||
|
static int
|
||||||
|
buf_len(struct telnetd_buf *buf)
|
||||||
|
{
|
||||||
|
return buf->ptr;
|
||||||
|
}
|
||||||
|
/*---------------------------------------------------------------------------*/
|
||||||
void
|
void
|
||||||
shell_quit(char *str)
|
shell_quit(char *str)
|
||||||
{
|
{
|
||||||
s.state = STATE_CLOSE;
|
s.state = STATE_CLOSE;
|
||||||
}
|
}
|
||||||
/*-----------------------------------------------------------------------------------*/
|
/*---------------------------------------------------------------------------*/
|
||||||
void
|
void
|
||||||
telnetd_quit(void)
|
telnetd_quit(void)
|
||||||
{
|
{
|
||||||
|
@ -113,41 +153,16 @@ telnetd_quit(void)
|
||||||
process_exit(&telnetd_process);
|
process_exit(&telnetd_process);
|
||||||
LOADER_UNLOAD();
|
LOADER_UNLOAD();
|
||||||
}
|
}
|
||||||
/*-----------------------------------------------------------------------------------*/
|
/*---------------------------------------------------------------------------*/
|
||||||
static void
|
|
||||||
sendline(char *line)
|
|
||||||
{
|
|
||||||
static unsigned int i;
|
|
||||||
|
|
||||||
for(i = 0; i < TELNETD_CONF_NUMLINES; ++i) {
|
|
||||||
if(s.lines[i] == NULL) {
|
|
||||||
s.lines[i] = line;
|
|
||||||
break;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
if(i == TELNETD_CONF_NUMLINES) {
|
|
||||||
dealloc_line(line);
|
|
||||||
}
|
|
||||||
}
|
|
||||||
/*-----------------------------------------------------------------------------------*/
|
|
||||||
void
|
void
|
||||||
shell_prompt(char *str)
|
shell_prompt(char *str)
|
||||||
{
|
{
|
||||||
char *line;
|
buf_append(&buf, str, strlen(str));
|
||||||
line = alloc_line();
|
|
||||||
if(line != NULL) {
|
|
||||||
strncpy(line, str, TELNETD_CONF_LINELEN);
|
|
||||||
petsciiconv_toascii(line, TELNETD_CONF_LINELEN);
|
|
||||||
sendline(line);
|
|
||||||
}
|
|
||||||
}
|
}
|
||||||
/*-----------------------------------------------------------------------------------*/
|
/*---------------------------------------------------------------------------*/
|
||||||
void
|
void
|
||||||
shell_default_output(const char *str1, int len1, const char *str2, int len2)
|
shell_default_output(const char *str1, int len1, const char *str2, int len2)
|
||||||
{
|
{
|
||||||
static unsigned len;
|
|
||||||
char *line;
|
|
||||||
|
|
||||||
if(str1[len1 - 1] == '\n') {
|
if(str1[len1 - 1] == '\n') {
|
||||||
--len1;
|
--len1;
|
||||||
}
|
}
|
||||||
|
@ -155,43 +170,24 @@ shell_default_output(const char *str1, int len1, const char *str2, int len2)
|
||||||
--len2;
|
--len2;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
/* PRINTF("shell_default_output: %.*s %.*s\n", len1, str1, len2, str2);*/
|
||||||
|
|
||||||
#if TELNETD_CONF_GUI
|
#if TELNETD_CONF_GUI
|
||||||
telnetd_gui_output(str1, len1, str2, len2);
|
telnetd_gui_output(str1, len1, str2, len2);
|
||||||
#endif /* TELNETD_CONF_GUI */
|
#endif /* TELNETD_CONF_GUI */
|
||||||
line = alloc_line();
|
buf_append(&buf, str1, len1);
|
||||||
if(line != NULL) {
|
buf_append(&buf, str2, len2);
|
||||||
line[TELNETD_CONF_LINELEN] = 0;
|
buf_append(&buf, "\r\n", 2);
|
||||||
strncpy(line, str1, TELNETD_CONF_LINELEN);
|
|
||||||
if(len1 < TELNETD_CONF_LINELEN) {
|
|
||||||
strncpy(line + len1, str2, TELNETD_CONF_LINELEN - len1);
|
|
||||||
if(len1 + len2 < TELNETD_CONF_LINELEN) {
|
|
||||||
line[len1 + len2] = 0;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
len = (unsigned int)strlen(line);
|
|
||||||
if(len < TELNETD_CONF_LINELEN - 2) {
|
|
||||||
line[len] = ISO_cr;
|
|
||||||
line[len+1] = ISO_nl;
|
|
||||||
line[len+2] = 0;
|
|
||||||
}
|
|
||||||
petsciiconv_toascii(line, TELNETD_CONF_LINELEN);
|
|
||||||
sendline(line);
|
|
||||||
}
|
|
||||||
}
|
}
|
||||||
/*-----------------------------------------------------------------------------------*/
|
/*---------------------------------------------------------------------------*/
|
||||||
PROCESS_THREAD(telnetd_process, ev, data)
|
PROCESS_THREAD(telnetd_process, ev, data)
|
||||||
{
|
{
|
||||||
PROCESS_BEGIN();
|
PROCESS_BEGIN();
|
||||||
|
|
||||||
tcp_listen(HTONS(23));
|
tcp_listen(HTONS(23));
|
||||||
memb_init(&linemem);
|
buf_init(&buf);
|
||||||
|
|
||||||
shell_init();
|
shell_init();
|
||||||
shell_file_init();
|
|
||||||
shell_ps_init();
|
|
||||||
shell_run_init();
|
|
||||||
shell_text_init();
|
|
||||||
shell_time_init();
|
|
||||||
|
|
||||||
#if TELNETD_CONF_GUI
|
#if TELNETD_CONF_GUI
|
||||||
telnetd_gui_init();
|
telnetd_gui_init();
|
||||||
|
@ -212,106 +208,80 @@ PROCESS_THREAD(telnetd_process, ev, data)
|
||||||
|
|
||||||
PROCESS_END();
|
PROCESS_END();
|
||||||
}
|
}
|
||||||
/*-----------------------------------------------------------------------------------*/
|
/*---------------------------------------------------------------------------*/
|
||||||
static void
|
static void
|
||||||
acked(void)
|
acked(void)
|
||||||
{
|
{
|
||||||
static unsigned int i;
|
buf_pop(&buf, s.numsent);
|
||||||
|
|
||||||
while(s.numsent > 0) {
|
|
||||||
dealloc_line(s.lines[0]);
|
|
||||||
for(i = 1; i < TELNETD_CONF_NUMLINES; ++i) {
|
|
||||||
s.lines[i - 1] = s.lines[i];
|
|
||||||
}
|
|
||||||
s.lines[TELNETD_CONF_NUMLINES - 1] = NULL;
|
|
||||||
--s.numsent;
|
|
||||||
}
|
|
||||||
}
|
}
|
||||||
/*-----------------------------------------------------------------------------------*/
|
/*---------------------------------------------------------------------------*/
|
||||||
static void
|
static void
|
||||||
senddata(void)
|
senddata(void)
|
||||||
{
|
{
|
||||||
static char *bufptr, *lineptr;
|
int len;
|
||||||
static int buflen, linelen;
|
len = MIN(buf_len(&buf), uip_mss());
|
||||||
|
PRINTF("senddata len %d\n", len);
|
||||||
bufptr = uip_appdata;
|
buf_copyto(&buf, uip_appdata, len);
|
||||||
buflen = 0;
|
uip_send(uip_appdata, len);
|
||||||
for(s.numsent = 0; s.numsent < TELNETD_CONF_NUMLINES &&
|
s.numsent = len;
|
||||||
s.lines[s.numsent] != NULL ; ++s.numsent) {
|
|
||||||
lineptr = s.lines[s.numsent];
|
|
||||||
linelen = (int)strlen(lineptr);
|
|
||||||
if(linelen > TELNETD_CONF_LINELEN) {
|
|
||||||
linelen = TELNETD_CONF_LINELEN;
|
|
||||||
}
|
|
||||||
if(buflen + linelen < uip_mss()) {
|
|
||||||
memcpy(bufptr, lineptr, linelen);
|
|
||||||
bufptr += linelen;
|
|
||||||
buflen += linelen;
|
|
||||||
} else {
|
|
||||||
break;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
uip_send(uip_appdata, buflen);
|
|
||||||
}
|
}
|
||||||
/*-----------------------------------------------------------------------------------*/
|
/*---------------------------------------------------------------------------*/
|
||||||
static void
|
static void
|
||||||
closed(void)
|
closed(void)
|
||||||
{
|
{
|
||||||
static unsigned int i;
|
|
||||||
|
|
||||||
for(i = 0; i < TELNETD_CONF_NUMLINES; ++i) {
|
|
||||||
if(s.lines[i] != NULL) {
|
|
||||||
dealloc_line(s.lines[i]);
|
|
||||||
}
|
|
||||||
}
|
|
||||||
}
|
}
|
||||||
/*-----------------------------------------------------------------------------------*/
|
/*---------------------------------------------------------------------------*/
|
||||||
static void
|
static void
|
||||||
get_char(u8_t c)
|
get_char(u8_t c)
|
||||||
{
|
{
|
||||||
if(c == ISO_cr) {
|
PRINTF("telnetd: get_char '%c' %d %d\n", c, c, s.bufptr);
|
||||||
|
|
||||||
|
if(c == 0) {
|
||||||
return;
|
return;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
if(c != ISO_nl && c != ISO_cr) {
|
||||||
s.buf[(int)s.bufptr] = c;
|
s.buf[(int)s.bufptr] = c;
|
||||||
if(s.buf[(int)s.bufptr] == ISO_nl ||
|
|
||||||
s.bufptr == sizeof(s.buf) - 1) {
|
|
||||||
if(s.bufptr > 0) {
|
|
||||||
s.buf[(int)s.bufptr] = 0;
|
|
||||||
petsciiconv_topetscii(s.buf, TELNETD_CONF_LINELEN);
|
|
||||||
}
|
|
||||||
shell_input(s.buf, s.bufptr);
|
|
||||||
s.bufptr = 0;
|
|
||||||
} else {
|
|
||||||
++s.bufptr;
|
++s.bufptr;
|
||||||
}
|
}
|
||||||
|
if(((c == ISO_nl || c == ISO_cr) && s.bufptr > 0) ||
|
||||||
|
s.bufptr == sizeof(s.buf)) {
|
||||||
|
if(s.bufptr < sizeof(s.buf)) {
|
||||||
|
s.buf[(int)s.bufptr] = 0;
|
||||||
|
}
|
||||||
|
petsciiconv_topetscii(s.buf, TELNETD_CONF_LINELEN);
|
||||||
|
PRINTF("telnetd: get_char '%.*s'\n", s.bufptr, s.buf);
|
||||||
|
shell_input(s.buf, s.bufptr);
|
||||||
|
s.bufptr = 0;
|
||||||
|
}
|
||||||
}
|
}
|
||||||
/*-----------------------------------------------------------------------------------*/
|
/*---------------------------------------------------------------------------*/
|
||||||
static void
|
static void
|
||||||
sendopt(u8_t option, u8_t value)
|
sendopt(u8_t option, u8_t value)
|
||||||
{
|
{
|
||||||
char *line;
|
char line[4];
|
||||||
line = alloc_line();
|
|
||||||
if(line != NULL) {
|
|
||||||
line[0] = (char)TELNET_IAC;
|
line[0] = (char)TELNET_IAC;
|
||||||
line[1] = option;
|
line[1] = option;
|
||||||
line[2] = value;
|
line[2] = value;
|
||||||
line[3] = 0;
|
line[3] = 0;
|
||||||
sendline(line);
|
buf_append(&buf, line, 4);
|
||||||
}
|
|
||||||
}
|
}
|
||||||
/*-----------------------------------------------------------------------------------*/
|
/*---------------------------------------------------------------------------*/
|
||||||
static void
|
static void
|
||||||
newdata(void)
|
newdata(void)
|
||||||
{
|
{
|
||||||
u16_t len;
|
u16_t len;
|
||||||
u8_t c;
|
u8_t c;
|
||||||
|
uint8_t *ptr;
|
||||||
|
|
||||||
len = uip_datalen();
|
len = uip_datalen();
|
||||||
|
PRINTF("newdata len %d '%.*s'\n", len, len, (char *)uip_appdata);
|
||||||
|
|
||||||
|
ptr = uip_appdata;
|
||||||
while(len > 0 && s.bufptr < sizeof(s.buf)) {
|
while(len > 0 && s.bufptr < sizeof(s.buf)) {
|
||||||
c = *(char *)uip_appdata;
|
c = *ptr;
|
||||||
uip_appdata = (char *)uip_appdata + 1;
|
PRINTF("newdata char '%c' %d %d state %d\n", c, c, len, s.state);
|
||||||
|
++ptr;
|
||||||
--len;
|
--len;
|
||||||
switch(s.state) {
|
switch(s.state) {
|
||||||
case STATE_IAC:
|
case STATE_IAC:
|
||||||
|
@ -369,18 +339,16 @@ newdata(void)
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
/*-----------------------------------------------------------------------------------*/
|
/*---------------------------------------------------------------------------*/
|
||||||
void
|
void
|
||||||
telnetd_appcall(void *ts)
|
telnetd_appcall(void *ts)
|
||||||
{
|
{
|
||||||
static unsigned int i;
|
|
||||||
if(uip_connected()) {
|
if(uip_connected()) {
|
||||||
tcp_markconn(uip_conn, &s);
|
tcp_markconn(uip_conn, &s);
|
||||||
for(i = 0; i < TELNETD_CONF_NUMLINES; ++i) {
|
buf_init(&buf);
|
||||||
s.lines[i] = NULL;
|
|
||||||
}
|
|
||||||
s.bufptr = 0;
|
s.bufptr = 0;
|
||||||
s.state = STATE_NORMAL;
|
s.state = STATE_NORMAL;
|
||||||
|
shell_start();
|
||||||
}
|
}
|
||||||
|
|
||||||
if(s.state == STATE_CLOSE) {
|
if(s.state == STATE_CLOSE) {
|
||||||
|
@ -388,21 +356,17 @@ telnetd_appcall(void *ts)
|
||||||
uip_close();
|
uip_close();
|
||||||
return;
|
return;
|
||||||
}
|
}
|
||||||
|
|
||||||
if(uip_closed() ||
|
if(uip_closed() ||
|
||||||
uip_aborted() ||
|
uip_aborted() ||
|
||||||
uip_timedout()) {
|
uip_timedout()) {
|
||||||
closed();
|
closed();
|
||||||
}
|
}
|
||||||
|
|
||||||
if(uip_acked()) {
|
if(uip_acked()) {
|
||||||
acked();
|
acked();
|
||||||
}
|
}
|
||||||
|
|
||||||
if(uip_newdata()) {
|
if(uip_newdata()) {
|
||||||
newdata();
|
newdata();
|
||||||
}
|
}
|
||||||
|
|
||||||
if(uip_rexmit() ||
|
if(uip_rexmit() ||
|
||||||
uip_newdata() ||
|
uip_newdata() ||
|
||||||
uip_acked() ||
|
uip_acked() ||
|
||||||
|
@ -411,4 +375,4 @@ telnetd_appcall(void *ts)
|
||||||
senddata();
|
senddata();
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
/*-----------------------------------------------------------------------------------*/
|
/*---------------------------------------------------------------------------*/
|
||||||
|
|
Loading…
Add table
Reference in a new issue