39,21 → 39,72 |
#include <console/console.h> |
#include <proc/thread.h> |
#include <arch.h> |
#include <string.h> |
|
static indev_t srlnout; |
|
indev_operations_t srlnout_ops = { |
static indev_operations_t srln_raw_ops = { |
.poll = NULL |
}; |
|
static void ksrln(void *arg) |
{ |
indev_t *in = (indev_t *) arg; |
srln_instance_t *instance = (srln_instance_t *) arg; |
bool cr = false; |
uint32_t escape = 0; |
|
while (true) { |
uint8_t ch = _getc(in); |
wchar_t ch = indev_pop_character(&instance->raw); |
|
/* ANSI escape sequence processing */ |
if (escape != 0) { |
escape <<= 8; |
escape |= ch & 0xff; |
|
if ((escape == 0x1b4f) || (escape == 0x1b5b) || (escape == 0x1b5b33)) |
continue; |
|
switch (escape) { |
case 0x1b4f46: |
case 0x1b5b46: |
ch = U_END_ARROW; |
escape = 0; |
break; |
case 0x1b4f48: |
case 0x1b5b48: |
ch = U_HOME_ARROW; |
escape = 0; |
break; |
case 0x1b5b41: |
ch = U_UP_ARROW; |
escape = 0; |
break; |
case 0x1b5b42: |
ch = U_DOWN_ARROW; |
escape = 0; |
break; |
case 0x1b5b43: |
ch = U_RIGHT_ARROW; |
escape = 0; |
break; |
case 0x1b5b44: |
ch = U_LEFT_ARROW; |
escape = 0; |
break; |
case 0x1b5b337e: |
ch = U_DELETE; |
escape = 0; |
break; |
default: |
escape = 0; |
} |
} |
|
if (ch == 0x1b) { |
escape = ch & 0xff; |
continue; |
} |
|
/* Replace carriage return with line feed |
and suppress any following line feed */ |
if ((ch == '\n') && (cr)) { |
cr = false; |
continue; |
65,24 → 116,44 |
} else |
cr = false; |
|
/* Backspace */ |
if (ch == 0x7f) |
ch = '\b'; |
|
indev_push_character(stdin, ch); |
indev_push_character(instance->sink, ch); |
} |
} |
|
void srln_init(indev_t *devin) |
srln_instance_t *srln_init(void) |
{ |
indev_initialize("srln", &srlnout, &srlnout_ops); |
thread_t *thread |
= thread_create(ksrln, devin, TASK, 0, "ksrln", false); |
srln_instance_t *instance |
= malloc(sizeof(srln_instance_t), FRAME_ATOMIC); |
if (instance) { |
instance->thread |
= thread_create(ksrln, (void *) instance, TASK, 0, "ksrln", false); |
|
if (!instance->thread) { |
free(instance); |
return NULL; |
} |
|
instance->sink = NULL; |
indev_initialize("srln", &instance->raw, &srln_raw_ops); |
} |
|
if (thread) { |
stdin = &srlnout; |
thread_ready(thread); |
} |
return instance; |
} |
|
indev_t *srln_wire(srln_instance_t *instance, indev_t *sink) |
{ |
ASSERT(instance); |
ASSERT(sink); |
|
instance->sink = sink; |
thread_ready(instance->thread); |
|
return &instance->raw; |
} |
|
/** @} |
*/ |