26,12 → 26,12 |
* THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. |
*/ |
|
/** @addtogroup genarch |
/** @addtogroup genarch |
* @{ |
*/ |
/** |
* @file |
* @brief Serial line processing. |
* @brief Serial line processing. |
*/ |
|
#include <genarch/srln/srln.h> |
40,50 → 40,49 |
#include <proc/thread.h> |
#include <arch.h> |
|
chardev_t srlnin; |
static chardev_t *srlnout; |
static indev_t srlnout; |
|
static void srlnin_suspend(chardev_t *d) |
{ |
} |
|
static void srlnin_resume(chardev_t *d) |
{ |
} |
|
chardev_operations_t srlnin_ops = { |
.suspend = srlnin_suspend, |
.resume = srlnin_resume, |
indev_operations_t srlnout_ops = { |
.poll = NULL |
}; |
|
static void ksrln(void *arg) |
{ |
chardev_t *in = (chardev_t *) arg; |
uint8_t ch; |
|
while (1) { |
ch = _getc(in); |
indev_t *in = (indev_t *) arg; |
bool cr = false; |
|
while (true) { |
uint8_t ch = _getc(in); |
|
if (ch == '\r') |
if ((ch == '\n') && (cr)) { |
cr = false; |
continue; |
} |
|
chardev_push_character(srlnout, ch); |
if (ch == '\r') { |
ch = '\n'; |
cr = true; |
} else |
cr = false; |
|
if (ch == 0x7f) |
ch = '\b'; |
|
indev_push_character(stdin, ch); |
} |
} |
|
|
void srln_init(chardev_t *devout) |
void srln_init(indev_t *devin) |
{ |
thread_t *t; |
|
chardev_initialize("srln", &srlnin, &srlnin_ops); |
srlnout = devout; |
indev_initialize("srln", &srlnout, &srlnout_ops); |
thread_t *thread |
= thread_create(ksrln, devin, TASK, 0, "ksrln", false); |
|
t = thread_create(ksrln, &srlnin, TASK, 0, "ksrln", false); |
ASSERT(t); |
thread_ready(t); |
if (thread) { |
stdin = &srlnout; |
thread_ready(thread); |
} |
} |
|
/** @} |
*/ |
|